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SUMMARY 


The  objective  of  this  program  was  to  develop  a Digital  Flight  Director 
Computer  capable  of  adapting  to  different  aircraft  types  and  varying 
geometric  conditions.  This  required  the  implementation  of  a multi- 
stage decision  process  and  an  error  correction  system.  A predictive 
corrective  technique  is  utilized  to  compute  aircraft  velocity,  distance 
to  station  and  mean  wind  allowing  for  compensation  of  these  terms  during 
beam  capture.  To  aid  in  the  estimation  process,  a Kalman  filter  was 
developed.  The  capture  computations  direct  the  aircraft  along  the  arc 
of  a circle  tangential  to  the  aircraft  flight  path  and  the  center  line 
of  the  radio  beam. 

In  order  to  demonstrate  the  capability  of  the  control  to  adapt  Lo  widely 
differing  aircraft,  a simulation  effort  was  perforitied  using  four  air- 
craft models;  a jet  transport,  a propeller  driven  aircraft,  a business 
jet,  and  a jet  fighter.  The  results  of  these  simulations  verified 
the  effectiveness  of  the  control  law  for  all  four  aircraft. 

Implenientaticn  of  the  above  techniques  required  the  development  of  a 
high  speed  general  purpose  digital  computer.  The  interface  between 
the  computer  and  existing  aircraft  attitude  and  navigation  systems 
was  accomplished  by  developing  digital  to  analog  and  analog  to  digital 
conversion  techniques  tailored  to  the  aircraft  signals. 

Two  prototype  562A-14  Digital  Flight  Director  computers  and  one  377C-1 
Airspeed  Controller  were  designed  and  fabricated  for  a flight  test 
program. 

Airworthiness  of  the  562A-14  was  confirmed  according  to  the  Equipment 
Test  Plan  during  environmental  tests  at  Collins.  The  unit  was  installed 
in  a T-39  aircraft  at  Randolph  Air  Force  Base  and  operated  successfully 
during  flight  tests  in  all  modes:  OFF,  Manual  Heading,  TACAN  and  ILS. 
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This  document  has  been  prepared  as  a final  report  with  the  intent 
to  communicate  the  complete  desiyn  of  the  562A-14  Digital  Flight 
Director  Computer,  developed  under  Air  Force  Contract  F33657-73-C-0120. 

The  performance  of  present  analog  flight  director  computers  varies 
with  aircraft  dynamics,  geometry,  and'airsoeed.  These  computers  can 
only  be  adjusted  to  give  optimum  performance  over  a relatively  nar>-ow 
range  of  conditions,  and  are  not  capable  of  being  directly  interchanged 
betv/een  different  types  of  aircraft  without  changes  in  the  control  laws. 
Once  adjusted  for  the  aircraft,  performance  is  optimized  only  for  a 
finite  range  of  airspeeds  and  geometric  conditions  (geometry  of  the 
ground  beam,  and  position  of  the  aircraft  relative  to  the  beam).  Their 
basic  inability  to  derive  ground  speed  and  distance  to  station  results 
in  a sluggish  response  at  long  distances  and  excessively  fast  under- 
damped response  at  short  distances  from  the  ground  station. 

The  objective  of  this  program  was  to  develop  a universal  flight  direc- 
tor computer  capable  of  providing  optimum  performance  for  any  aircraft 
under  all  flight  conditions,  without  reouiring  any  changes  in  the  com- 
puter. Additionally  the  flight  director  was  to  be  independent  of  the 
aircraft  equations  and  would  not  require  storage  of  the  aircraft  dyna- 
mics. Performance  requirements  and  unit  specifications  were  set  forth 
in  the  Statement  of  Work  for  the  Digital  Flight  Director  Computer. 

This  document  is  a comprehensive  report  on  the  total  program  which 
included  formulation  of  a universal  flight  director  control  law, 
software  and  hardware  prototype  development,  and  simulation  and  flight 
tests  performed  to  verify  the  system.  Section  i introduces  program 
activities.  Section ti  contains  a detailed  description  of  the  prototype 
hardware.  Section iiiis  an  analytical  discussion  of  the  Kalman  Filter 
and  of  the  Manual  Heading,  TACAN,  and  ILS  control  laws.  Section  iv 
provides  a detailed  presentation  of  the  software  implemented.  Simula- 
tion study  results  are  presented  in  Section  v Sectionyi  contains  flight 
test  results. 

Flow  charts  of  the  Digital  Flight  Computer  Software  are  presented  in 
Appendix  A.  Definitions  of  the  terms  used  within  the  software  proprams 
are  contained  in  Appendix  B.  Program  listings  of  DFDC  software  in 
floating  point  Fortran , scaled  fraction  Fortran,  and  AED  are  presented 
in  Appendices  C,  D,  and  E. 
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SECTION  TI 


2.0  HARa-.'ARE  IMPLEMENTATION 

2.1  General  Characteristics 

The  562A-14  Digital  Flight  Director  Computer  (DFDC),  Collins  Part 
No.  622-1824-001,  shown  in  Figure  i contains  a general  purpose 
digital  computer,  an  aircraft  systems  interface  unit  and  a rear 
mounted  power  converter.  The  digital  computer  and  interface  unit 
are  constructed  on  eleven  multilayer  printed  circuit  cards.  Flight 
control  programs  are  stored  internally  in  programmable  read  only 
memories. 

The  unit  is  contained  in  an  ARINC  one-half  ATR  short  case. 

A 100  pin  aircraft  interface  connector,  a 100  pin  test  connector, 
an  elapsed  time  indicator  and  a press  to  test  push  button  and 
failure  annunciator  are  located  on  the  front  panel. 

The  377B-1  Airspeed  Controller  (ASC) , Collins  Part  No.  622-1825-001, 
shown  in  Figure  2 was  developed  to  provide  mode  selection  and 
presettable  airspeed  inputs  to  the  DFDC. 

2.2  Interfacing  Systems 

2.2.1  Flight  Director  Inputs 

An  interface  is  effected  with  the  following  aircraft  systems  to 
provide  the  DFDC  with  the  input  signals  listed  below: 

Aircraft  Attitude  System 
•Roll  (degrees) 

•Pitch  (decrees) 

Horizontal  Situation  Indicator 
•Manual  Heading  Error  (degrees) 

•Course  Error  (degrees) 

61 ides  lope  Receiver 

•Glideslope  Deviation  (microamps) 

Wki 

Local  1 zer  Recei ver 

•Localizer  Deviation  (microamps) 

TACAN  Receiver 

•TACAN  Deviation  (degrees) 

Radar  Altimeter 

• Radar  A1 ti tude  (feet) 

DME  Receiver 
•Range  (miles) 

Air  Data  Computer 

. True  Airspeed  (Knots) 
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Airspeed  Controller 
• Mode 

•Airspeed  (knots) 


Flight  Director  Outputs 

The  DFDC  supplies  the  attitude  Director  Indicator  and  Horizontal 
Situation  Indi cator  wi th  the  output  signals  listed: 

Attitude  Director  Indicator 

• Vertical  Pointer  Position 

• Vertical  Pointer  Flag 

• Horizontal  Pointer  Position 

• Horizontal  Pointer  Flag 

• Gli deslope  Deviation 

• Glideslope  Flag 

• Glideslope  Engage 

• Flight  Director  Valid 

Horizontal  Situation  Indicator 

• Lateral  Deviation 

• Lateral  Deviation  Flag 


Block  Diagram 

The  DFDC  Block  Diagram  is  shown  in  Figure  2.3.  Each  circuit  function 
is  identified  with  its  card  assembly.  Major  functions  located  on  the 
five  card  assemblies  of  the  aircraft  interface  unit  are  as  follows: 

A1  DME  UNITS  CONVERTER 

(SYNCHRO  TO  DC  SIN,  COS  DEMODULATORS) 

A2  PITCH,  ROLL  CONVERTERS 

(SYNCHRO  TO  DC  SIN,  COS  DEMODULATORS) 

ILS,  TACAN  RECEIVERS 
(MODULATED  DC  TO  DC  CONVERTERS) 

AIRSPEED,  RADAR  ALTITUDE  DC  RECEIVERS 

LOW  LEVEL  FLAG  RECEIVERS 

OUTPUT  BUFFERS  (GS,  LATERAL  DEVIATION) 

A3  COURSE  & HEADING  ERROR  CONVERTERS 

(CONTROL  TRANSFORMER  TO  DC  ANGLE  DEMODULATORS) 

ANALOG  MULTIPLEXER 

SAMPLE  AND  HOLD 

ANALOG  TO  DIGITAL  CONVERTER 
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INPUT  STORAGE  REGISTER 


A4  DISCRETE  RECEIVERS 

OUTPUT  CONTROL  LOGIC 
DISCRETE  DRIVERS 
DIGITAL  TO  ANALOG  CONVERTERS 
AS  MASTER  OSCILLATOR  AND  TIt€R 

I/O  CONTROL  LOGIC 

The  aircraft  interface  unit  provides  the  link  between  the  digital 
processor  and  the  aircraft  analog  systems.  Analog  input  signals  are 
filtered,  demodulated  and  scaled  by  input  converters  and  Supplied  to 
an  analog  multiplexer.  The  output  of  the  multiplexer  is  connected  to 
an  analog  to  digital  converter  through  a sample  and  hold  circuit. 

Twelve  bits  of  data  from  the  analog  to  digital  converter  are  placed 
in  the  input  storage  register  and  enabled  onto  the  data  bus  on  processor 
request. 

All  data  transactions  between  the  ai rcraft  interface  unit  and  the 
processor  are  conducted  on  the  transfer  bus  which  consists  of  a 16  bit 
data  bus,  a 12  bit  adoress  bus  and  6 control  lines. 

The  processor  selects  input  data  by  forwarding  a five  bit  code  via  the 
address  bus  to  the  I/O  control  logic  which  selects  the  appropriate 
multiplex  channel  and  initiates  A to  D operation.  During  the  time 
that  analog  data  is  being  digitized  the  proce‘"sor  proceeds  v/i  th  other 
computations.  Once  the  data  is  ready  the  I/O  control  logic  sends 
an  interrupt  to  the  processor.  The  processor  then  requests  the  data 
in  the  input  storage  register.  Data  is  then  placed  on  the  transfer 
bus.  Discrete  inputs  and  mode  control  signals  are  converted  to  TTL 
logic  levels  and  placed  on  the  transfer  bus  as  requested  by  the 
processor. 

After  the  completion  of  processor  computations,  output  data  is  supplied 
to  the  vertical  and  horizontal  pointer  D to  A converters  and  discrete 
drivers  via  the  transfer  bus.  New  data  is  sent  to  these  converters 
once  every  100  milliseconds. 

The  computer  implemented  in  the  DFDC  is  a member  of  the  Collins  adaptive 
processing  system  (CAPS)  family  of  computers.  This  processor,  designated 
CAPS-2,  is  a general  purpose  stack  oriented  digital  computer.  It  is 
utilized  to  perform  flight  control  computations,  mode  switching,  and 
self  monitoring.  The  basic  unit  contains  a 16  bit  parallel  execution 
unit  referred  to  as  the  central  processing  unit  (CPU),  a 1024  word 
by  16-bi ts-per-word  high  speed  mos  read-write-memory  and  a 4096  word 
by  8-bi ts-per-word  high  speed  bipolar  programmable  read-only-memory 
that  contains  program  instructions.  Machine  architecture  is  consistent 
with  compiler  techniques  to  allow  programs  written  in  high-level  lan- 
guage to  be  compiled  into  efficient  machine  lanouaqe  programs. 
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Major  functions  located  on  the  six  card  assemblies  of  the  CAPS-2  pro- 
cessor are  as  follows: 


A6 

I STORE  (INSTRUCTION  MEMORY) 
S STORE  (STACK  MEMORY) 

A7 

MEMORY  CONTROL 
S STORE 

A8 

INTERRUPT,  CLOCK  MEMORY  INTERFACE  LOGIC 

A9 

DATA  PATH  LOGIC  (CPU) 

AlO 

MICROCONTROLLER 

All 

CONTROL  STORE 

Ai rcraft 

Systems  Interface 

2.4.1  Input  Parameters 


The  conversion  and  scalinq  of  analog  input  parameters  to  a diaital 
format  compatible  with  the  CAPS-2  processor  is  accomplished  by  the 
aircraft  interface  unit.  Table  i describes  signal  format  and 
scaling  for  each  input  received. 

2.4.2  Input  Circuitry 

Dual  micropower  operational  amplifiers  were  selected  for  input  re- 
ceiving, scaling,  and  demodulation  functions  to  minimize  power 
dissipation  and  board  space. 

2. 4. 2.1  Synchro  Demodulators  (CARD  A2) 

Pitch  and  Roll  synchro  inputs  are  converted  to  sin  and  cos  and  demodulated 
on  the  A2  card  assembly.  In  order  to  improve  the  accuracy  of  these  dc 
outputs  the  standard  26V  reference  has  been  replaced  as  a demodulator 
phase  control  signal  by  the  400  cycle  cosine  term  derived  from  the 
synchro  inputs.  Since  the  typical  maximum  value  of  roll  and  pitch 
inputs  is  45  degrees  and  20  degrees  respectively,  the  cosine  signals 
will  be  maintained  at  not  less  than  7 volts,  and  can  be  utilized  as 
a phase  reference  for  both  sin  and  cos  terms. 

2 .4.2.2  Radio  Receivers  (CARD  A2) 


The  90  to  150  Hz  modulated  Localizer,  Glideslope,  and  TACAH  signals  are 
received  differentially,  amplified,  filtered,  and  outputted  to  the  ana- 
log multiplexer.  A two  stage  second  order  filter  is  utilized  to  pro- 
vide 60  db  of  attenuation  at  100  Hz.  and  to  minimize  delay  of  the  input 
signal.  Pnase  oelay  of  the  Localizer  Glideslope  and  TACAN  receivers 
is  0.5  degrees  at  0.1  radian. 

The  differential  receivers  used  for  Radar  Altitude  and  Airsoeed  provide 
20  db  of  400  cycle  attenuation  and  result  in  a phase  delay  of  8 degrees 
at  1 radian. 
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TABLP  1.  OFOC  INPUT  CONVERSION  DATA 
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(1)  Synchro  inputs  are  normalized  by  the  software. 
Norn,  value  for  Sin  = 1 or  Cos  = 1 is  9 volts 


2. 4. 2. 3  Heading  & Course  Error  Demodulators  (CARD  A3) 


Course  and  Heading  Error  control  transformer  outputs  from  the  HSI  are 
demodulated  by  utilizing  the  26  V reference  from  the  HSI  heading  synchro. 

In  order  to  provide  constant  demodulator  output  with  a variable  refer- 
ence voltage  the  26V  reference  is  compared  with  the  demodulated  sin  and 
cos  input  signals.  The  filtered  result  of  this  comparison  is  a dc  out- 
put directly  proportional  to  error  angle. 

2.4. 2. 4 Flag  Receiver  (CARD  A4) 

Glideslope,  Localizer,  and  TACAN  flag  signals  are  accepted  by  differential 
receivers  with  IK  input  impedance.  Noise  immunity  is  provided  by  schmitt 
triggers  at  the  receiver  outputs.  Trip  points  and  hysteresis  are  illus- 
trated in  Figure  4 

2. 4. 2. 5 Analog  Multiplexer  (CARD  A3) 

The  sixteen  scaled  dc  voltages  from  the  synchro  demodulators  and  differ- 
ential receivers  are  multiplexed  through  complimentary  MOS  analog  switches 
to  the  summing  junction  of  an  operational  amplifier.  This  arrangement 
permits  zero  voltage  current  switching  to  minimize  linearity  and  cross- 
talk errors. 

2.  4. 2, 6 A to  D Conversion  (CARD  A3) 

The  Analog  Multiplexer  output  is  connected  directly  to  a sample  and  hold 
function  tc  insure  that  the  A to  D converter  input  voltage  will  remain 
constant  during  the  conversion  process.  A successive  approximation  ana- 
log to  digital  converter  was  chosen  for  this  application  to  provide  con-  ^ 

version  times  of  less  than  200  usee.  The  total  time  required  for  signal  ; 

conversions  is  3.2  msec.  The  12  bit  A to  D provides  5 mv  of  resolution 
and  10  mv  of  accuracy  over  the  -55  to  +125  C temperature  range.  Input 
signal  range  is  -10  to  +10  volts. 

2. 4.2.7  Digitizing  Accuracy 

The  worst  case  errors  introduced  by  DFDC  scaling  and  digitizing  are 
listed  in  Table  2 ■ Predicted  errors  were  obtained  by  determining  the 

maximum  offset  and  gain  error  for  each  circuit  in  a signal  path,  and 

assuming  all  errors  to  be  additive.  The  root  sum  squared  of  these  1 

errors  is  entered  in  Table  2 along  with  results  obtained  from  labora-  , 

tory  breadboard  operating  over  the  -55  C to  +125  C temperature  range. 

Laboratory  tests  were  conducted  to  verify  the  critical  offset  errors 
of  the  complex  synchro  demodulator  circuits  utilized  for  ROLL,  PITCH, 

DME.  and  CRS  and  HDG  Error  inputs.  Non-military  parts  were  utilized  for 
these  tests  and  final  configuration  DFDC  units  are  expected  to  provide  , 

improved  accuracy.  Since  final  configuration  0.1%  resistors  were  not  | 

available  at  the  time  the  tests  were  performed,  1%  resistors  were  ' 

utilized  and  the  observed  gain  errors  were  much  greater  than  predicted. 
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Output  Parameters 


The  DFDC  outputs  analog  pitch  and  bank  steering  coimands , glide- 
slope  deviation,  and  flag  control  logic  to  the  Attitude  Director 
Indicator.  It  provides  the  Horizontal  Situation  Indi cator  wi th  later- 
al beam  deviation  and  radio  validity  logic.  Characteristics  of  DFDC 
outputs  are  listed  in  Table  3 . 

2.4.4  Output  Circuitry 

The  aircraft  interface  unit  converts  dinital  data  received  from  the 
processor  at  a refresh  rate  of  lOHZ,  to  analon  outputs  compatible 
with  the  ADI  and  HSI.  Two  12  bit  A to  D converters  are  provided  for 
pitch  and  roll  steering  commands.  The  resolution  and  refresh  rate 
of  the  A to  D converters  insures  smooth,  jitter  free  outputs.  Flag 
and  validity  outputs  are  converted  from  logic  levels  to  indicator 
compatible  inputs  by  discrete  transistor  circuitry. 

2.4.4. 1 Output  Control  Logic  (CARD  A4) 

Output  data  received  from  the  processor  is  stored  in  three  registers, 
implemented  with  comolimentary  mos  devices.  Four  parallel  in  serial 
out  shift  registers  provide  storage  for  the  Horizontal  and  Vertical 
Pointer  data.  Eacn  time  the  registers  are  updated  new  data  is  trans- 
ferred serially  to  the  D to  A converters,  under  the  direction  of  the 
output  control  logic.  Independent  control  functions  for  the  A to 
D converters  allow  processor  refreshing  of  either  register  during 
serial  data  transfer  to  the  converters.  The  control  logic  responds 
to  the  output  "data  accept"  signal  from  the  I/O  control  and  deter- 
mines the  processor  selected  output  signal  by  interrogating  the 
least  significant  three  bits  of  the  Address  Bus.  Discrete  control 
bits  are  received  from  the  Data  Bus  and  stored  in  an  eight  bit 
complimentary  mos  register.  The  discrete  output  drivers  are  de- 
signed to  source  300  ua  to  loads  from  400  to  1200  ohms  and  will  drive 
either  one  or  two  external  flags. 

2. A. 4, 2 Output  Accuracies 

Table  4 describes  the  predicted  worst  case  error  for  DFDC  output 
conversion  circuitry  as  compared  with  specified  accuracies  within 
MIL  C 83014A. 

2.4.5  I/O  Control  Logic  (CARD  A5) 

Digital  data  Crans'f'er,  between  the  I/O  conversion  circuitry  and  the 
CAPS-2  processor,  is  accomplished  by  utilizing  the  processor  data 
and  address  buses  and  the  control  signals  shown  in  Fiqure  ' 5 . The 
I/O  control  logic  monitors  address  bus  and  control  signals  to 
determine  when  I/O  action  is  requested  and  the  operation  required 
as  illustrated  in  Figure  6. 
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tabu;  3.  DFDC  OUTPUl  SIGNALS 
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A.  OUTPUT  CONVERSION  ERROR  PREDICTIONS 
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I/O  Select  = lORQ  • [17700  ^ Address  1 7737] 

I/O  Select  = lORQ  • A12  -All  * AlO  • A9  • A8  • A7  • A6  • (A5)* 
Storage  Register  Select  = I/O  Select  • A4  • A3  * A2  ■ A1  * AO 
Data  Output  = I/O  Select  • (10  WR}* 

Discrete  Input  Request  = I/O  Select  • A4  • A3  • A2  • A1  • (AO)* 
A to  D Conversion  Request = I/O  Select  ■ (lOWR)*  • (DIR)*  ■ (SRS) 


The  following  mnemonics  apply: 
lORQ  - 10  Request 
lOWR  - 10  Write 
DIR  - Discrete  Input  Request 
SRS  - Storage  Register  Select 


Figure  6.  T/n  Control  LorIc 
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2.4.5. 1 Data  Input 

Input  parameters  are  selected  b>  the  five  least  significant  bits 
of  the  address  bus  as  illustrated  in  Table  5 . Analog  data  is 
digitized  and  placed  in  the  input  storage  register  200  microseconds 
after  a processor  request.  An  I/O  generated  interrupt  is  then  sent 
to  the  processor  v;hicn  requests  the  storage  register  data.  This 
operation  permits  the  processor  to  perform  other  computations  dur- 
ing input  conversion.  Discrete  inputs  are  converted  to  TTL  logic 
levels  and  placed  on  tne  data  bus  upon  processor  request.  Location 
of  each  discrete  input  on  the  data  bus  in  shown  in  Table  6 . 

2. 4.5.2  Data  Output 

The  I/O  Control  Logic  accepts  and  stores  processor  output  data  and 
initiates  the  D to  A conversion  process.  Since  D to  A control 
functions  are  independent,  the  processor  is  not  required  to  wait 
for  one  conversion  to  complete  before  initiating  another. 

2.4.5. 3 Oscillator  and  Master  Timer  (CARO  A5) 

A 16  mhz  counter  and  synchonous  timing  chain  generate  clock  signals 
for  the  DFDC.  The  following  timer  output  signals  are  available  at 
the  A5  connector; 

CLK8M  - 8 MHZ  clock 

CLK4M  - 4 MHZ  clock 

CLK2M  - 2 MHZ  clock 

CLKIM  - 1 MHZ  clock 

CLK.5M  - 0.5  MHZ  clock 

CLK.25M  - 0.25  MHZ  clock 

The  mcister  timer  also  provides  the  CAPS  computer  with  two  timer 
interrupts  to  initiate  the  main  computation  cycle  and  the  glideslope 
computation.  The  interrupts  are  1 usee  in  length  and  occur  at  100 
msec  intervals.  The  time  relationship  between  timer  1 and  timer  2 
may  be  adjusted  by  moving  one  jumoer  wire  located  on  the  A5  card 
assembly.  The  diagram  of  Figure  7 shows  the  timer  relationships 
aval lable. 

The  master  timer  utilizes  low  po<wer  schottky  synchronous  counters  to 
provide  divisions  of  16,  14,  15,  15  and  16.  An  8 m.hz  input  to  the 
timer  is  divided  down  to  9.921  nz.  In  order  to  minimize  skew  be- 
tween tlie  3 mhz  and  9.9  hz  clocks  the  master  timer  is  implemented 
with  look  ahead  enabling  gates  wliich  effectively  eliminate  the  race 
conditions  charactistic  pf  long  odd  multiple  dividing  chains. 
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TAiiLE  5.  I/O  ADDRESSES 


ADDRESS 

PARAMETER 

ADDRESS 

PARAMETER 

177 

00 

Vertical  Pointer 

177  32 

Self  Test  Constant  (+) 

177 

01 

Horizontal  Pointer 

1 77  33 

RUSIN 

177 

02 

Output  Discretes 

177  34 

Airspeed  Reference 

Output 

177 

03 

Spare 

177  35 

RUCOS 

Data 

177 

04 

Spare 

177  36 

Discretes 

177 

05 

Spare 

177  37 

Input  Storage  Register 

177 

06 

Spare 

177 

07 

Spare 

177 

10 

Pitch  Sin 

177 

11 

Pitch  Cos 

177 

12 

Roll  Sin 

177 

13 

Roll  Cos 

177 

14 

Range  T Sin 

177 

15 

Range  T Cos 

177 

16 

Range  H Sin 

177 

17 

Range  H Cos 

Input 

177 

20 

Crs  Error 

Data 

177 

21 

Hdg  Error 

177 

22 

Loc  Dev 

177 

23 

Tac  Dev 

177 

24 

G/S  Dev 

177 

25 

Comp  AS 

177 

26 

Man  AS 

177 

27 

Radar  Alt 

177 

30 

Horiz  Pointer 

177 

31 

Vertical  Pointer 
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TABLE  6.  I/O  DISCRETE  BIT  POSITIONS 


Discrete 


Data  Bus 

Inputs 

Outputs 

DBOO 

MAN  HDG 

DBOl 

ILS 

DB02 

TAC 

DB03 

SELF  TEST 

DB04 

MAN  AS 

DB05 

VBS  OR 

DB06 

LBS  OR 

DB07 

TAC  FLAG 

DB08 

LOC  FLAG 

Horiz  Ptr  Jn  View 

DB09 

G/S  FLAG 

Vert  Ptr  in  View 

DBIO 

RALT  VALID 

Processor  No  Go 

D811 

(GP  Engage)* 

OBI  2 

G/S  Flag  In  View 

DB13 

Loc  Flag  In  View 

DB14 

Horiz  Ptr  Flag  In  View 

DB15 

Vert  Ptr  Flag  In  View 

Notes ; 

1)  Data  Bus  signals 

in  the  logic  1 

state  imply  that  the  flags 

2)  A selected  mode  will  result  in  a logical  1 in  its  respective  bus  bit. 
The  OFF  mode  is  defined  as:  DBOO  + DBOl  + DB02  = 0 
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2, 4. 5. 4 Power  Cn  Clear  (CARD  A5) 


Initialization  of  processor  and  I/O  logic  functions  is  accomplished 
by  the  Power  On  clear  circuitry  which  monitors  the  five  volt  logic 
power  and  generates  a 50  msec  output  pulse  as  the  logic  power  rises 
past  4.7  volts. 

2.5  DIGITAL  COMPUTER 


2.5.1  General  Characteristics 

The  computer  organization  and  instruction  set  defined  in  this  docu- 
ment provides  digital  flight  director  processing  and  control. 

The  processor  is  a binary,  fixed  point,  parallel  machine.  The 
organization  and  instruction  set  provide  processing  and  control 
using  a stack-oriented  archi tecture.  Basic  data  word  length  is 
16  bits  with  double  precision  capability.  Instruction  word  length 
is  3 bits.  Instructions  are  called  program  syllables.  Priority 
interrupt  and  direct  memory  access  provide  flexible  device  inter- 
face capability.  All  devices,  including  the  Central  Process  Unit 
(CPU),  communicate  via  a single  bus.  The  processor  addresses  both 
device  registers  and  memory  storage  in  a single  homogeneous  address- 
ing structure. 

The  CPU  is  organized  using  microprogrammed  control. 

Features  of  the  processor  include  the  follcrwing: 

a.  Implied  and  relative  addressing  of  data  and  last-in,  first-out 
stacking  of  data.  As  a result,  there  is  reduced  load  on  the 
program  for  data  addressing  and  space  management. 

b.  Nested  subroutine  capability  using  last-in,  first-out  stack 
concepts. 

c.  Eight  bit  instruction  syllables  having  no  address  fields. 
(Literals  fetched  from  memory  can  be  interpreted  as  addresses.) 

d.  Bus  oriented  CPU  structure. 

e.  Semiconductor  memory  using  MOS  RAM's  for  main  data  storage  and 
PROM's  (Programmable  read-only-miemori es ) for  instruction  and 
micro  control  store  memory.  Mask  developed  ROM's  would  be 
considered  for  a production  model  to  save  pov/er,  space  and 
hardware  costs. 

f.  Use  of  low  power  shottky  MSI  devices  to  reduce  power  and  space 
requi rcments . 

g.  Microprogrammed  control.  This  provides  a disciplined  aooroach 
to  the  control  design.  The  result  is  design  simplicity,  minimum 
parts,  ease  of  manufacturing  and  ease  of  functional  changes  (for 
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example,  modification  of  existing  machine  instructions  or  addition 
of  new  ones) . 


h.  The  ability  to  supplement  the  machine  language  with  microprogrammed 
subroutines  which  handle  functions  that  cannot  be  accomplished  in 
real  time  at  the  machine  language  level.  Digital  flight  director 
subroutines  include  arithmetic  operations  and  an  input  data  interrupt 
handler. 

1.  The  architecture  of  the  machine  allows  a program  written  in  a high- 
level  language  to  be  easily  compiled  into  a very  efficient  machine 
language  program. 

The  basic  characteristics  of  the  machine  are  summarized  in  Table  7 
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TABLE 


SUMMARY  CHARACTERISTICS  OF  CAPS  2 (DIGITAL  ^LlCHl  DIRECTOR) 


Processor  Organization: 
Instruction  Format: 

Data  Type: 

Instruction  Count: 


LIFO  (Last-in,  first-out  stack)  concept. 
8-bit  syllables  (zero  address). 

16-bit  fixed  point,  fractional  binary. 

47 


Execution  Times: 

Add/Subtract:  3 microseconds. 

Multiply:  22  microseconds. 

Data  Reference/Assignment:  3 microseconds  typical. 


Input/Output: 


16-bit  parallel  data  bus. 
Direct  memory  access. 

Program  access  to  I/O  devices. 
Priority  interrupts. 


Memory: 


Semiconductor. 

4096  8-bit  instruction  words. 
1024  16-bit  data  words. 


Power : 


20  watts. 


Size: 


Less  than  100  square  inches. 
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2 5.2 


STACK  OPERATION 


Within  the  computer  is  the  stack,  sometimes  called  a push-down 
store  or  LIFO  (last-in,  first-out)  list.  An  operation  implicitly 
specifies  a storage  location  as  a source  or  destination  of  data 
to  or  from  the  top  of  a list  of  contiguous  storage  words.  Operands 
are  referenced  from  the  top  of  the  list  and  the  result  operands 
normally  replace  the  operands  at  the  top  of  the  list. 

Conceptually,  a push-down  stack  is  a set  of  registers  of  which  only 
one  is  externally  accessible.  Data  is  loaded  or  "pushed"  into  the 
stack  through  this  one  register.  When  new  data  is  loaded,  previously 
loaded  data  moves  sequentially  "down"  from  one  renister  to  the  next 
in  the  set.  All  data  is  retrieved  or  "popped"  in  the  reverse  order 
from  that  in  which  it  was  loaded. 

The  actual  implementation  of  the  stack  is  in  the  main  memory  of  the 
processor.  A set  of  successive  locations  in  the  memory  is  used  for 
the  stack.  Instead  of  data  actually  moving  from  location  to  location 
during  a push  or  a pop,  the  address  of  the  last  entry  in  the  stack  is 
stored  in  a stack  pointer.  The  pointer  can  be  incremented  or  decre- 
mented and  points  to  the  location  that  is  currently  the  top  of  the 
stack. 

An  example  of  stack  usage  is  the  evaluation  of  an  arithmetic  expres- 
sion. Consider  the  following  expression; 

X = (A-B)/(C+D) 

The  expression  can  be  formatted  into  "reverse  Polish  notation"  (the 
commas  may  be  omitted): 

A,B,-C,D,+  ,/,X= 

This  notation  eliminates  parentheses  because  each  mathematical  operator 
refers  not  to  the  two  operands  betv/een  which  it  stands,  but  to  the 
two  operands  preceding  it  - or,  in  the  case  of  unary  operators,  to 
only  the  first  preceding  operand.  (This  is  the  translation  that  a 
complier  does  to  a high-level  language  prior  to  generating  machine 
language. ) 

To  evaluate  on  expression  in  Polish  notation,  the  program  contains  a 
reference  instruction  (a  "push")  for  each  variable,  a mathematical 
instruction  (such  as  ADD)  for  each  operator  in  the  expression,  and  an 
assign  instruction  (a  "pop")  for  the  = sign. 

Mathematical  instructions  operate  on  the  too  one  or  two  items  in  the 
stack  and  replace  them  with  the  result.  The  assign  instruction  uses 
the  address  of  the  dependent  variable  X as  the  location  in  main  memory 
for  storina  the  result  of  the  evaluation.  This  sequence  is  illustrated 
in  Figure  8 . 
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STACK  EVALUATION 


The  computer  implements  the  stack  in  a contiguous  block  of  random 
access  memory.  (The  random  access  memory  is  referred  to  as  the 
S-memory. ) Figure  9 presents  this  view  in  graphical  form.  The 
notation  for  the  words  within  the  accumulator  stack  are  as  follows: 

SO:  The  top  word  in  the  stack  (the  latest  word  entered  and 

available  to  machine  operations). 

SI:  The  second  word  in  the  stack,  located  in  the  next  higher 

numbered  memory  location. 

S2:  The  third  word  in  the  stack,  in  a memory  position  next 

higher  numbered  from  SI. 

Theoretically,  the  number  of  words  in  the  accumulator  stack  is  un- 
limited. However,  machine  operations  rarely  require  more  than  four 
words. 

The  stack  function  is  controlled  by  pointers  in  scratch  pad  memory. 
These  pointers  are  accessible  only  by  the  micro-control  logic.  They 
are  as  follows: 

1 . TOS  (Top  of  Stack) 

A 16-bit  v;ord  in  scratch  pad  memory  (P-memory)  contains  the  memory 
address  (pointer)  of  the  top  word  of  the  accumulator  stack  (i.e., 
the  last  word  that  v/as  inserted  into  the  stack  and/or  the  first 
word  to  be  removed).  TOS  can  be  incremented  ('POP'),  removing  the 
top  word  of  the  stack,  or  can  be  decremented  ('PUSH'),  making 
room  for  an  additional  word  in  the  stack.  The  top  of  the  stack  is 
redefined  by  TOS  (the  contents  of  the  stack  do  not  move). 

The  actual  implementation  of  the  digital  flight  director  processor 
allows  the  top  two  words  in  the  stack  to  be  maintained  in  CPU 
registers.  This  reduces  main  memory  accesses,  increasing  program 
^ execution  speed.  The  algorithm  for  the  implementation  is  discussed 
in  the  section  describing  the  microcontroller. 

2.  LENV  (Local  Environment  Pointer) 

The  empty  condition  of  the  accumulator  stack  occurs  when  the  top 
of  the  stack  pointer  (TOS)  equals  the  value  of  LENV,  a 16-bit  word 
in  scratch  pad  containing  the  memory  address  of  the  first  word 
(lowest  numbered  address)  of  the  Local  Environment.  The  Local 
Environment  is  a maximum  of  32  16-bit  words  per  subroutine  located 
in  memory  which  can  be  accessed  by  a class  of  instructions  ("Local 
Environment  Relative")  and  which  has  the  relative  address  of  the 
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Figure  9.  Stack  Organisation 


v/ord  v/ithin  the  Local  Environment  as  part  of  the  instruction 
syllable.  The  accumulator  stack  is  located  "above"  the  Local 
Environment;  i.e.,  the  bottom  word  of  the  stack  is  in  memory 
position,  LENV  minus  one. 

3.  GENV  (Global  Environment  Pointer) 

A 16-bit  register  containing  the  starting  address  (lowest  numbered) 
of  the  Global  Environment.  This  area  of  memory  contains  those 
variables  used  by  different  user  programs.  Instructions,  using 
GENV  as  a base,  generate  an  absolute  address  for  accessing  any 
word  of  memory.  S'. nee  there  is  only  one  user  program  in  the 
digital  flignt  director  application,  GENV  has  only  one  value, 
zero,  and  there  is  no  need  of  a GENV  register  pointer. 

4.  SPCR  (Program  Syllable  Counter) 

SPCR  is  a 16-bit  v;ord  in  scratchy  pad  memory  capable  of  being 
loaded-,  incremented,  and  decremented  ’in  the  ALU  under  micro- 
program control.  The  least  significant  12  bits  point  to  the 
syllable  address  (8-bit  syllables)  to  be  executed. 

• 

A characteristic  of  SPCR,  common  to  all  instructions,  is  that 
SPCR  (during  the  execution  of  an  instruction)  is  pointing  to  the 
address  of  the  next  syllable  to  be  executed  in  a linear  string 
of  syllables.  SPCR  can,  of  course,  be  modified  by  transfer 
instructions  or  by  Conditionals  occurring  within  the  body  of  an 
instruction. 
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2.5.3 
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PROCESSOR  ORGA^JIZATION 

The  digitdl  flight  director  processor  organization  is  shown  in 
Figure  lO  . Basically,  the  processor  consists  of  four 
functional  eleiiients  as  follows: 

1.  Data  path  logic: 

The  data  path  logic  contains  the  mechanisms  for  data  manipulation 
in  the  machine.  The  logic  includes  an  ALU,  a scratch  pad  memory, 
several  registers,  and  main  memory  interface  logic. 

The  data  is  manipulated  and  main  memory  is  accessed  under  control 
of  the  ml crocontrol ler.  The  scratch-pad  memory  contains  pointers 
that  implement  the  program  counter  and  space  management  functions 
of  the  machine. 

2.  Mi  control ler: 

The  microcontrol  ler  provides  the  logical  contro''  of  the  data 
path  logic.  The  control  store  memory  (built  from  read-only- 
memory  elements)  contains  a programmed-structured  sequence  of 
commands  which  are  translated  into  hardware  control  signals. 

Control  store  address  and  branch  logic  contains  the  necessary 
decision  logic  to  allow  execution  of  machine  instructions 
fetched  from  the  instruction  memory.  The  decision  logic  can 
change  the  state  of  the  machine  as  a result  of  external  inter- 
rupts or  instructions. 

3.  Main  Memory: 

This  functional  element  provides  storage  for  the  macro-program 
and  the  random  access  space  required  for  the  execution  of  the 
program. 

4.  Interrupt  Logic: 

This  logic  allows  external  devices  to  change  the  state  of  the 
machine  by  alerting  the  microcontroller  of  some  condition. 
Priority  is  assigned  to  each  kind  of  interrupt.  Interrupts 
can  also  be  generated  internally  under  micro  programmed  control. 

A fr^tn  function  is  that  of  direct  memory  access  (DMA).  This 
function  is  distributed  among  the  various  devices  attached  to  the 
memory  bus  and  allows  each  device  (including  the  central  processing 
unit)  to  contend  for  use  of  the  memory  bus.  All  devices  communi- 
cate with  the  main  memory  via  the  memory  bus. 
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The  term  CPU  (Central  Processing  Unit)  as  used  in  this  document 
refers  to  the  data  path  logic,  microcontroller,  scratch  pad 
memory,  and  data  path  registers. 


2. 5.3.1  DATA  PATH  LOGIC 


The  processor  data  path  logic  consists  of  the  following  major 
sublets : 


1 . ALU  Data  Bus 

2.  Arithmetic  Logic  Unit 

3.  MQ,  B,  L and  A Registers 

4.  Scratch  Pad  Memory  (P-Store) 

A block  diagram  of  the  data  path  logic  is  shown  in  Figure  n . 
2. 5. 3.1.1  ALU  DATA  BUS 

The  bus  multiplexer  places  one  of  eight  sources  on  the  ALU  data 
bus.  These  are: 


1 . 
2. 

3. 

4. 

5 . 

6. 

7. 

8. 


MQ  Register:  Multiplier/Quotient  and  utility  values 

1;  Register:  ALU  result  operand 

P- Memory:  Scratch  pad  values 

Control  Store:  Literal  value  from  microprogram 

Mem.ory:  Data  from  the  main  memory  bus 

L Left:  L-register  data  shifted  left  one  place 

L Right:  L-register  data  shifted  right  one  place 

Interrupt  L Byte:  Interrupt  value  in  least  significant 

eight  bits  and  L register  least  significant  bits  in  the 

most  sionificant  eignt  bits. 


Selection  of  the  data  to  the  ALU  data  bus  is  under  microprogrammed 
control  using  a three  bit  address  vector  from  control  store. 

< Sixteen  low-power  schottky  multiplexer  devices  are  used  to 
■ impletment  the  function. 

Z. 5. 3. 1.2  ARITHMETIC  LOGIC  UNIT 

The  ALU  is  constructed  from  low  power  schottky  ALU/function 
generateor  integrated  circuits.  These  integrated  circuits  can 
perform  48  different  arithmetic  and  logical  operations  on  two 
input  data  words.  Table  8 summarizes  these  functions. 

The  selection  of  functions  is  done  with  an  ALU  opcode  vector.  This 
vector  is  supplied  by  the  micro  controller  or  is  partially  derived 
from  the  least  significant  four  bits  of  the  MQ  register.  The  lat 
is  usea  in  execution  of  the  boolean  instruction  (BOOL  is  defined 
in  the  instruction  set  section). 
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TABLE  8.  .AH’  ELEBfE'rr  OPERATir>N  TABLE 


I n 

I 

j SELECTION 
[ S3  S2  SI  SO 

L L L L 

L L L ri 

L L H L I 

t 

111  H H ! 

j 

LULL 
L h L H 

L h H L 

j L H H H 

H L L L 

K L L H 

^ H L H L 

H L H H 

' H ri  L L 

I 

• K H L H j 

' H H H L I 

i 

' M ri  H H I 

Each  bit  is 


ACTIVE-HIGH  DATA 


M = H 
LOGIC 
FUNCTIONS 

r M = L:  ARITHf^ETIC  OPERATIONS 

C^  = H 
(no  carry) 

t 

(with  carry) 

F = A 

F = A 

F = A PLUS  1 

F = A + B 

F = A + B 

F = (A+B)  PLUS  1 

F = AB 

F = A + B 

F = (A+B)  PLUS  1 

F = 0 

F = MINUS  1 (2's  COMPL) 

F = ZERO 

F = AB 

F = A PLUS  AB 

F = A PLUS  AB  PLUS  1 

F = B 

F = (A+B)  PLUS  AB 

F = (A+B)  PLUS  AB  PLUS  1 

F = A I-  B 

F = A MINUS  B MINUS  *1 

r = A MINUS  B 

F = AB 

F * AB  MINUS  1 

F = AB 

j 

F = A + B 

F = A PLUS  AB 

F = A PLUS  AB  PLUS  1 

F = OT 

F = A PLUS  B 

F = A PLUS  B PLUS  1 

F = B 

F = (A+B)  PLUS  AB 

F = (A+B)  PLUS  AB  PLUS  1 

F = AB 

F = AB  MINUS  1 

F = AB 

1 

f = 1 

F = A PLUS  A* 

F = A PLUS  A PLUS  1 

1 

F = A + 3 

j 

F = (A+3)  PLUS  A 

F = (A+B)  PLUS  A PLUS  1 

F = A + B ! 

F = (A+B)  PLUS  A 

F = (A+B)  PLUS  A PLUS  1 

F = A 1 

i F = A MINUS  1 

F = A 

shifted  to  the  next  more  significant  position. 
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Operations  are  affected  by  operating  on  data  from  the  B register 
and  ALU  data  bus.  The  outputs  of  the  ALU  can  be  stored  in  the 
L or  A registers. 

2. 5. 3,1. 3 MQ.  B.  L,  ANO  A REGISTERS 

In  addition  to  a scatch-pad  memory,  several  registers  are  used 
for  temporary  storaqe  of  results.  They  are  not  visible  to  the 
macroprogram,  only  to  the  microprogram.  Lew  power  shottky  register 
devices  (54L194)  are  used  for  register  functions.  Register 
functions  are  described  below; 

MQ  Register: 

The  HQ  register  is  used  as  a utility  register  in  the  execution  of 
Instructions.  Its  primary  value  is  in  the  execution  of  the  multiply 
and  divide  instructions,  hence  the  name  MQ  (for  multiplier/quotient). 
MQ  can  be  parallel  loaded  or  shifted  right  or  left  one  bit  at  a 
time.  Its  primary  uses  can  be  cataloged  as  follows; 

1.  Multiply  ''’j 

HQ  holds  the  multiplier.  Bit  MQ(0:1)  is  examined  to  determine 
if  the  multiplicand  in  T is  to  be  added  to  the  partial  product 
(PP).  MQ  is  shifted  right  one  bit  along  v/ith  PP.  The  least 
significant  bit  of  PP  (ALU  output)  is  shifted  into  the  msb  of 
MQ.  HQ  holds  the  completed  product  after  16  shifts. 

2.  Divide 

HQ  hold  the  quotient  bits  as  they  are  generated.  MQ  is  shifted 
left  one  bit  and  the  quotient  bits  are  shifted  into  bit  0 each 
step. 

3.  Boolean 

In  the  BOOL  opcode,  MQ(0.4)  contain  the  "opcode"  as  defined 
elsewhere  and  as  retrieved  from  the  stack.  The  bits  are  used 
to  directly  control  the  ALU. 

Closely  associated  with  the  MQ  register  is  the  SB  (s^gn  buffer) 
flip  flop.  During  execution  of  the  multiply  instruction,  it 
holds  the  original  sign  of  the  multiplier  (the  multiplier  is 
“shiftfcd-out"  during  execution).  SB  is  used  to  determine  if 
the  multiplicand  is  to  be  added  to  or  substracted  from  the 
partial  product.  During  division,  SB  holds  first  the  sign  of 
the  dividend.  SB  is  then  EOR'ed  with  the  divisor  sign  to  hold 
the  sign  of  the  finished  quotient.  01 V is  affected  with  all 
positive  numbers.  At  the  completion  of  the  algorithm,  SB 
deterxiines  if  the  quotient  is  to  be  complemented. 
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B-RECISTER: 


This  register  is  driven  from  the  ALU  data  bus.  The  output 
provides  one  of  the  operands  to  the  arithmetic  and  logic  unit. 

The  B-register  can  be  parallel  loaded  or  shifted  right  or  left 
one  bit  at  a time  under  microprogram  control.  The  least 
significant  eight  bits  of  the  6-register  are  also  used  for 
temporary  storage  of  instruction  literals  during  execution  of 
the  instruction  fetch  microroutine. 

L-REGISTER: 

The  L-register  provides  temporary  storage  of  arithmetic  and 
logical  results  from  the  ALU.  It  is  operated  under  micro- 
programmed control. 

A-REGISTER: 

The  A (address)  register  is  loaded  from  the  ALU  bus  under  micro- 
programmed control.  The  register  is  used  to  address  main  memory 
and  I/O  devices.  The  outputs  are  enabled  to  the  address  bus 
only  after  the  CPU  has  been  granted  bus  service. 

2.5. 3. 1.4  SCRATCHPAD  (P-MEMORY): 

The  P-mem.ory  is  a 16  word  bipolar  memory.  It  is  not  accessible 
by  software  (user  macroprograms) . Addresses  to  P-memory  come  only 
and  directly  from  the  control  store  under  microprogrammed  control. 

P-memory  is  used  for  utility  storage  during  execution  of  micro- 
routines, for  storage  of  pointers  defining  the  current  program, 
and  for  storage  of  constants  and  other  special  variables.  Pointers 
in  this  memory  are  SPCR,  TOS,  and  LENV.  These  pointers  are  initial- 
ized during  the  mi croprogrammed  power-on-clear  sequence. 

Special  stack  registers  in  the  P-memory  are  used  as  extensions  of 
program  stacks  in  main  memory.  Their  use  reduces  the  number  of 
memory  accesses  that  would  be  required  if  the  stacks  were  entirely 
located  in  main  memory. 
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2. 5. 3. 2 MICROCONTROLLER 


The  advantages  of  microprogrammed  control  are  well  documented. 

It  provides  a disciplined,  low  cost  approach  to  control  logic 
design.  In  past  years,  it  has  been  used  extensively  in  large 
computers  to  provide  a common  architecture  in  machines  covering 
a wide  range  of  cost  and  capability.  More  recently,  it  has 
been  used  in  minicomputers  to  customize  an  instruction  set  to 
a particular  application. 

Writing  the  microprogram  is  very  similar  to  writing  a problem 
program.  However,  the  microprogram  is  like  the  hardware  control 
logic  that  would  be  required  in  a non-mi croprogrammed  computer 
in  that  it  is  implemented  in  read-only  memory  and  is  not  altered 
after  the  machine  has  been  built.  Thus,  the  microprograms  might 
be  called  "firmware"  because  they  are  designed  like  software  and 
built  like  hardware.  The  DFDC  microprogram  is  contained  in 
Appendix  I. 

The  microcontroller  in  the  digital  flight  director  provides 
a flexible,  cost  effective  control  logic  design  that  allows 
addition  of,  modifications  to,  or  deletion  of  instructions  or 
operations  using  programming  techniques. 

2. 5. 3. 2.1  BASIC  OPERATION 

The  microcontroller  consists  of  four  parts:  clock  generation 

control  store  sequencer,  control  store  and  decode  logic,  and 
branch  control  logic.  Figure  12  shows  the  basic  structure  of 
the  microcontroller. 

The  function  of  the  microcontroller  is  to  provide  all  of  the 
necessary  control  signals  for  the  ALU  data  path  section.  It 
contains  sufficient  decision  making  logic  to  allow  proper 
sequential  operation  in  the  data  flow. 

A microsequence  is  initiated  by  parallel  loading  the  pIAC  (micro 
instruction  address  counter)  with  a control  store  starting  loca- 
tion. The  lAC  is  incremented  through  microsteps  (or  parallel 
loaded  with  branch  address  vectors  if  a branch  condition  exists) 
causing  the  emission  of  a new  set  of  control  signals  for  each 
microstep.  A microsequence  is  normally  terminated  by  branching 
to  a machine  control  microsequence  which  causes  the  fetch  of 
a new  instruction  of  execution  of  an  interrupt  microsequence 
if  an  interrupt  is  pending. 

2 .5. 3. 2. 2 CLOCK  GENERATION 

The  basic  microcycle  time  period  is  250  nanoseconds.  An  eight 
megahertz  clock  is  divided  by  two  to  achieve  the  resulting  four 
megahertz  microcycle  frequency. 
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Flpire  12.  Microcontroller 
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All  mi crocontrol led  state  changes  or  data  storage  occur  ' 

during  the  last  25%  of  a microcycle.  This  portion  of  the 
microcycle  is  called  clock  phase  four  and  the  signal  used  to 
change  state  or  load  data  has  the  mnemonic  CLKP4F. 

Figure  . .illustrates  the  basic  clock  signals  and  microcyle 
states.  A microcycle  is  initiated  by  CLKP4F  (ylAC  is  parallel 
loaded  or  incremented  with  the  leading  edge  of  CLKP4F).  After 
sufficient  delay  time  through  the  uIAC  and  control  store  memory, 
proper  control  signals  are  available.  Referring  .to  Figure  13  , 

valid  data  appears  on  the  ALU  data  bus  after  some  delay  time  through 
the  ALU  data  bus  multiplexer. 

Operations  on  and  destinations  for  ALU  data  are  determined  by 
appropriate  control  store  outputs.  Destination  storage  occurs 
using  CLKP4F.  Most  of  the  storage  occurs  synchronously  with 
the  leading  edge  of  this  clock  signal.  Havever,  the  scratch 
pad  memory  is  written  into  using  the  entire  duty  cycle  of 
CLKP4F. 

2. 5. 3. 2. 3 CONTROL  SEQUENCER 

Referring  to  Figure  i?  , the  control  store,  sequencer  consists 
of  an  instruction  mapper,  an  instruction  address  counter  (pIAC), 
a SAVE  register  and  a uIAC  multiplexer. 

The  pIAC  outputs  constitute  the  control  store  address  vector.  The 
counter  can  be  incremented,  cleared  to  zero  (used  to  initiate  a 
power-on-clear  microsequence),  or  parallel  loaded  with  a branch 
vector. 

The  mapper  translates  instruction  syllables  into  control  store 
address  vectors.  These  branch  vectors  represent  control  store 
starting  locations  for  microsequences  required  to  execute 
individual  instructions. 

The  SAVE  register  is  used  to  provide  subroutine  capability  at  the 
microroutine  level.  It  is  loaded  with  the  current  control  store 
address  vector  if  desired  and  then  is  used  as  a branch  return 
vector. 

The  ylAC  multiplexer  is  used  to  select  the  next  control  store 
address  vector  in  tlie  event  a branch  condition  exists  in  the 
current  state  of  the  microcontroller.  This  vector  can  be  selected 
from  any  of  the  following  sources: 

1.  Mapper 

2.  SAVE  Register 

3.  Machine  Operation  Vector  (Fetch  or  Interrupt) 

4.  Control  Store  Output  (Branch  Vector) 
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2.5. 3.2.4  CONTROL  STORE  AND  DECODE  LOGIC 

Data  paths  in  the  computer  are  controlled  by  control  store 
memory  outputs.  Certain  groups  of  control  signals  are  mutually 
exclusive  and  decode  is  used  to  provide  those  individual  control 
signals.  This  results  in  a savings  of  memory.  Figure  14  shnv/s 
control  store  mapping.  The  assignment  of  bit  positions  has  been 
arranged  to  ease  reprogrammi nq  by  assigning  each  field  where 
possible,  to  specific  PROM  package  columns.  Design  and  space 
is  provided  for  1024  words  of  control  store,  each  word  being 
32  bits  in  length. 

Figure  is  details  the  microprogram  field  definitions.  This 
figure  and  the  mapping  shown  in  Figure  14  provide  sufficient 
reference  information  to  prepare  the  microcode.  The  microcode 
(written  in  nmemonic  form)  is  then  supplied  as  data  to  a micro- 
assembler. The  mi croassembler  converts  these  nmemonics  to 
control  store  bit  patterns  and  assigns  addresses  to  each  step 
of  the  microprogram.  The  microassembler  also  converts  branch 
labels  to  control  store  addresses,  providing  labeled  microprogram 
entry  points. 

The  following  paragraphs  (and  Figure  14  ) briefly  describe  micro- 

program fields  and  nmemonic  meanings: 

Opcode  Field  (2  Bits) 

This  two-bit  field  is  used  to  determine  the  next  control  state  and 
to  define  alternate  uses  for  dependent  fields. 

Definitions  of  operations  specified  by  the  opcode  field  are: 

BNU  (Branch  Unconditionally):  ylAC  is  to  be  paralleled  loaded 

with  a branch  address  vector  at  the  end  of  the  current 
microcycle.  The  source  of  this  vector  is  determined  by 
the  branch  source  field. 

BCT  (Branch  Conditionally,  True):  Same  operation  as  BNU 

except  that  the  branch  will  occur  only  if  the  branch 
test  flip  flop  is  true  (set). 

BCF  (Branch  Conditionally,  False):  Same  as  BCT  except  criteria 

is  a false  condition. 

INC  (Increment):  J.AC  is  to  be  incremented. 
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T..  0 Transfer  Control  of  ALU  to  KQ  Registor 
N..  1 MIcroccntrol  of  AlU 

field  Id:  MTATt  (lit  10) 

■..  0 Rotate  Data  (Used  ulth  shift  optratlons) 

5..  1 Ro  Route 
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field  7:  PREPAOC  MCMORT  ACCESS  (Bit  19) 


RRR..  0 Moat  ucycle  is  Memory  Access 
■UN...1  ROP  Condition 


field  lOiAtU  Bus  Source  (Bits  16-18) 


ISMSI..  000  Shift  I rioet  to  AU)  Bus 
1*0*..  001  Put  I Register  on  ALU  Bus 
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»3«0..  on  Put  Mg  Rigister  on  ALU  Bus 
etfM..  ICO  Put  lelst  6 bits  of  V;rory  on  AlU  Bus 
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AhEO..  Gill  Test  Ai  U fur  tirgative  Condition 
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TO....  0000  Utility  Register 
0NC...OOO1  Integer  I 
T».‘.  ..  OSIO  Util  ity  'egistee 
T2....0011  Utility  legister 
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SPC2..  lOul  Sirliatiie  Pointer 

TQS  . . IS  10  Slat • Pointer 
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Branch  Set  Field  (T  Bit) 

SBR  (Set  Branch):  The  branch  test  flip  flop  is  to  be 

set  if  the  condition  specified  by  the  branch  select  field 
is  true. 

NTS  (No  Test):  NOP  Condition. 

SAVE  Register  Field  (1  Bit) 

SAV:  Load  the  SAVE  register  v;ith  the  current  value  of  ylAC. 

NSV  (No  Save):  NOP  Condition 
A Field  (4  Bits) 

This  field  allows  one  of  the  following  storage  or  state 
change  operations: 

- Load  address  register 

- Load  M 

- Load  address  register 

- Load  MQ  register 

- Load  most  significant  byte  of  MQ  register 

- Shift  MQ  register  left  one  bit 

- Shift  MQ  register  right  one  bit 

- Load  loop  counter 

- Increment  loop  counter 

- Set  microprogrammed  interrupts 

- Rest  selected  interrupt 

- Toggle  user  mode  flip  flop 

- Load  sign  bit  flip  flop 

- Load  sign  bit  flip  flop  (EOR) 

- Reset  stack  vector  bit  0 

- Reset  stack  vector  bit  1 

- Set  stack  vector 

- NOP  (No  Operation) 

B Field  (2  Bits) 

This  field  controls  the  operation  of  the  B register.  The 
B register  can  be  loaded  from  the  ALU  data  bus,  shifted  left 
one  bit,  or  shifted  right  one  bit. 

S,  P,  L Field  (2  Bits) 

This  field  is  used  to  cause  loading  of  the  L register,  a P- 
memory  write,  or  an  S-memory  write. 
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Memory  Access  Field  (1  Bit) 

If  this  bit  is  a zero, a memory  access  is  to  be  initiated 
immediately  after  completion  of  the  current  microcycle. 

ALU  Bus  Source  Field  (3  Bits) 

This  field  provides  direct  encoding  to  the  memory  bus 
multiplexer  to  gate  data  to  the  ALU  data  bus.  The  following 
are  possible  sources  for  ALU  bus  data: 

- MQ  Register 

- L Register  (ALU  outputs) 

- L Register  shifted  left  one  bit 

- L Register  shifted  right  one  bit 

- P-Memory 

- Least  significant  6 bits  of  memory 

- Literal  value  from  control  store 

- Interrupt  value  (N)  and  least  significant  byte  to 
most  significant  byte  on  ALU  bus. 

Branch  Control  Field  (4  Bits) 

This  field  selects  the  branch  test  condition.  If  a set  branch 
condition  exists,  the  branch  condition  flip  flop  will  assume 
the  boolean  value  of  the  test  selected. 

Branch  Source  Field  (2  Bits) 

This  field  selects  the  source  of  the  branch  vector.  It  also 
serves  as  ALU  control  transfer  and  rotate  control  (valid  only 
if  opcode  is  INC).  The  following  branch  vectors  may  be 
selected: 

- Control  Store  (Branch  Label) 

- Mapper  (Instruction  starting  address) 

- SAVE  Register 

- Instruction  Fetch/ Interrupt  Vector 
Carry  and  ALU  Opcode  Fields  (6  Bits) 


Six  bits  are  used  to  control  arithmetic  logic  functions  as 
described  in  section  2. 5. 3. 1.2. 


i 


Branch  Label  (10  Bits] 


If  a branch  opcode  exists  and  the  branch  vector  source  is 
ROM  (control  store),  then  this  field  provides  the  branch 
vector.  Otherv/ise,  this  field  is  the  ALU  opcode  and  P- 
address  fields. 


2. 5. 3.2. 5 BRANCH  CONTROL  LOGIC 


The  functions  of  the  branch  control  logic  are  as  follows: 

1.  Select  the  branch  test 

2.  Provide  a counter  for  microprogram  looping 

3.  Stack  vector  control 

4.  Control  the  parallel  loading  of  the  ylAC  on  branch  operations. 

Figure  ifi  shows  the  functional  concept  of  this  logic.  Branch 
test  conditions  are  fed  into  tri -state  multiplexers  and  are 
selected  under  control  of  the  branch  control  field  of  the  control 
store.  If  an  SBR  (set  branch)  condition  exists,  the  branch 
condition  flip  flop  will  be  set  with  the  results  of  the  selected 
test. 


PEF  signal  controls  the  parallel  loading  of  the  ;jIAC.  This  gate 
is  forced  to  a logical  zero  if  there  is  an  unconditional  branch 
or  is  a zero  conditionally  on  the  state  of  the  branch  condition 
flip  flop. 

The  loop  counter  is  loaded  under  microprogrammed  control  from  the 
ALU  data  bus.  The  TC  output  is  a 1 when  an  all  one's  condition 
exists  in  this  counter.  This  condition  is  testable. 

Flip  flops  EO  and  El  are  used  as  stack  register  indicators  to  show 
if  stack  data  is  stored  in  the  scratch  pad. 

2 .5. 3.2. 6 EXAMPLE  MICROSEQUENCE 

As  an  example  of  a microprogram,  consider  the  instruction  fetch 
operation.  The  microprogram  might  look  like  this: 


Step  Label 


Microprogram 


1 INTERP  PMEM  SPCR  STA  PASS  C LRG 

2 LRGR  PWR  SPCR  PRP 

3 BNu  MAP  KMEM  MQP  BRG 


Explanation  of  the  steps  are  as  follows: 
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Branch  Control 


Step  1 : Place  the  output  of  the  scratch  pad  (PMEM)  on  the  ALU  data 

bus.  SPCR  (Syllable  Program  Counter)  is  the  data  to  be 
read  from  the  scratch  pad.  The  data  is  to  be  stored  in  the 
address  register  (STA)  and  also  is  to  be  incremented  (PASS  C) 
and  stored  in  the  L register  (LR6). 

Step  2:  The  incremented  value  of  SPCR  is  to  be  placed  on  the  ALU 

data  bus  (LRGR  is  the  source)  and  written  into  the  scratch 
pad  (PWR)  at  location  SPCR.  At  the  end  of  this  microstep, 
a request  is  to  be  made  for  use  of  the  memory  bus  (PRP). 

Step  3:  During  this  step,  the  contents  of  the  program  memory 

(I-memory)  will  be  read  from  the  memory  data  bus  to  the  input 
.to  the  mapper.  The  microprogram  indicates  a branch  uncondi- 
tionally (BiNU)  to  the  branch  vector  from  the  mapper.  The 
branch  occurs  at  the  end  of  the  current  microstep. 

Also  during  execution  of  this  microstep,  the  least  signifi- 
cant bits  of  the  memory  bus  (KMEM)  are  put  on  the  ALU  data 
bus  and  stored  in  the  MQ  and  B registers.  This  value  is 
used  as  a LIT  value  and  as  an  index  value  for  referencing 
and  assigning  from  and  to  local  environment. 

STACK  rWilPULATION  ALGORITHM 

If  the  accummulator  stack  were  located  entirely  in  main  memory  (S- 
memcry),  the  number  of  memory  accesses  tends  to  be  much  higher  than 
a conventional  register  oriented  machine.  In  order  to  improve  operat- 
ing speed  of  the  CAPS  2 processor  two  of  the  scratch-pad  (P-memory) 
locations  are  used  as  extensions  of  the  accummulator  stack. 

The  internal  operation  makes  the  mixed  nature  of  the  implementation 
invisible  to  the  user.  The  microprogram  automatically  moves  informa- 
tion from  the  main  memory  location  pointed  to  by  TOS  and  the  registers 
located  in  P-memory  (a  and  b registers).  A vector  comprised  of  two 
indicators  Eg  and  E-|  is  used  to  specify  whether  the  a,  b registers 
respectively  contain  information  or  not.  The  flip  flops  containing 
these  indicators  is  shown  in  Figure  in  . The  condition  of  both 
registers  being  empty  is  one  of  the  inputs  to  the  mapper  and  allows 
different  instruction  microsequence  starting  locations  depending 
on  the  status  of  the  stack  registers.  This  condition,  plus  the 
condition  of  the  status  of  the  a register  (Eg)  are  branch  test 
conditions,  allowing  the  micro  program  to  determine  the  exact  status 
of  the  stack  registers.  The  data  flow  and  stack  vector  conditions 
are  shown  below: 
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Eq,  E^  = 00  both  registers  empty 
Eq,  E-|  =01  a empty,  b full 
Eq,  E^  = n both  full 
Eg,  E^  = 10  not  allowed 


2. 5. 3. 3 TRANSFER  BUS 

The  CAPS  system  is  structured  around  a common  bus,  interfacing  the 
processor,  memory  and  I/O  devices.  This  bus,  called  the  Transfer 
Bus,  provides  the  pathway  for  all  data  communications  among  all 
attached  units.  Both  device-to-memory  and  device-to-device 
communications  can  take  place  on  the  bus. 

2. S. 3. 3.1  BUS  STRUCTURE 

The  Transfer  Bus  may  be  partitioned  into  two  unrelated  but 
dependent  components:  the  data  transfer  busses  and  associated 

controls  and  the  bus  priority/contention  logic.  Figure  17 
shows  tnese  two  components.  Figure  18  lists  and  defines  the 
lines  in  each. 

AH  data  words  16  bits)  are  transferred  in  parallel  over  the 
Db  lines.  The  address  of  the  selected  device  or  memory  address 
is  placed  on  the  AB  address  bus.  Tne  controls  lORQ,  lORP  and 
lOWR  sequence  the  direction  and  timing  of  the  transfer. 

The  BRQ  (hus  request)  and  SEIZE  lines  and  the  daisy-chained  GRANT 
line  provide  control  over  which  device  is  to  have  access  to  the 
transfer  bus. 


LINE 

NO.  OF 
LINES 

ACTIVE 

DATA  TRANSFER  BUSS 

re, 

16 

LOW 

re, 

12 

LOW 

lORQ 

1 • 

LOW 

iOrp 

1 

LOW 

lOWR 

1 

LOW 

CLK8M 

1 

- 

bEVEN 

1 

LOW 

fault 

1 

LOW 

PRIORITY/CONTENTION 

LOGIC 

1 

LOW 

BG^  1 

(per  device) 

HIGH 

seTIe 

1 

LOW 

DEFINITION 

Bi-directional  data  bus  (I/O  from  "S") 
Address  bus 

"Request"  from  originating  device 

"Response"  from  addressed  device 

"Write  Select";  indicates  originating- 
to-selected  device  transfer 

8 MHz  clock  for  timing 

Device  enable  for  direct  access. 

Invalid  Address  Interrupt 

Bussed  Device  "Requests"  (Bids)  for 
use  of  DMA  channel . 

DME  Channel  "Grant"  from  higher- 
priority  device  to  next  lower-priority 
device. 

Device  has  received  "Grant"  and  has 
"SEIZE'd"  control  of  DMA  channel;  a 
"BUSY"  flag. 


VI  oiirp  1R,  Transfer  Him  l.inp  T>efinitions 
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2. 5. 3.3. 2 DATA  TRANSFER 


Once  a device  has  gained  access  to  the  bus  interface,  it  has 
and  can  retain  control  of  the  interface  until  its  needs  are 
satisfied.  It  can  transfer  one  or  a dozen  v/ords  before  releas- 
ing control.  All  other  devices  are  "locked  out"  during  this» 
time. 


The  controlling  (or  originating)  device  places  the  address  of 
the  requested  device  or  memory  location  on  the  address  bus  (AB). 

It  selects  the  direction  of  transfer  of  data  by  setting  lOWR 
appropriately.  lOWR  = 1 selects  data  out  of  the  originating 
device.  lORQ  is  set  v/hen  all  is  ready.  lORP  is  monitored  for 
a response  from  the  selected  device.  Then  lORQ  is  reset  and 
the  data  and  address  lines  cleared.  Figure  19  gives  the 
timing. 

Critical  points  are  labelled.  Point  A shovis  the  address  and 
lOWR  lines  being  set  up  before  lORQ  is  set  at  B.  The  final 
transition  of  lORP  at  C indicates  write  data  is  accepted  or 
read  data  is  available  on  the  DB.  Point  D is  acknowledgment 
of  the  lORP.  At  this  time  address  and  data  are  removed. 

There  are  no  timing  restraints  on  exactly  when  transitions  should 
occur.  Only  the  relative  timing  as  shov;n  in  the  figure  is 
critical.  Also  lORQ  and  lOR?  are  switched  in  synchronism  with 
(8MHz)  clock  transitions. 

2. 5.3. 3. 3 PRIORITY/CONTENTION  LOGIC 

In  order  for  a device  to  transfer  data  on  the  bus,  it  must  first 
gain  access  to  the  bus.  This  is  affected  by  the  bus  priority  and 
contention  hardware. 

When  a device  requires  use  of  the  direct  memory  access  interface, 
it  first  sets  the  Bus  Request  signal  (Figure  17  ).  This  request 

is  turned  around  and  serially  rippled  down  all  the  devices  in  the 
Bus  Grant  chain.  The  highest  priority  device  receives  the  grant 
first.  If  it  has  no  request  pending,  it  forwards  the  grant  to  the 
next  device  in  the  chain.  The  'grant'  stops  at  a requesting  device 
which  then  sets  the  'SEIZE'  bus  active.  This  'SEIZE'  signals  that 
a device  now  has  control  of  the  Transfer  Bus  interface.  All  further 
device  requests  are  inhibited  until  the  SEIZE  signal  is  reset. 

By  resetting  SEIZE  before  its  last  access  on  the  Transfer  Bus  is 
complete  the  active  device  allows  another  request-grant  cycle  to 
complete  before  the  access  is  complete.  This  overlap,  then,  causes 
most  or  all  of  the  contention  time  to  be  masked  out. 
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Figure  I').  I'ransfer  Bus  Timing 
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Figure  2f)  shows  the  request-grant  timing.  Device  2 in  the 

figure  has  set  Bus  Request  at  some  point  after  SEIZE  has  been  reset 
Bus  Grant  ripples  down  to  device  2 through  devices  0 and  1.  Device 
2 accepts  the  request,  sets  SEIZE  and  resets  its  bus  request.  All 
of  this  is  asynchronous. 

Once  a device  has  SEIZE'd  control  of  the  interface,  it  monitors 
lORQ  until  it  is  reset.  At  this  point  the  device  can  proceed  with 
its  own  I/O  transactions.  Here  the  bus  request/contention  activity 
is  overlapped  with  the  end  of  a previous  transaction.  A complete 
cycle  of  bus  request  plus  data  transfer  is  given  in  Figure  21 
This  shows  the  overlap. 


ADDRESSING 


In  the  digital  flight  director,  address  assignments  are  made  as 
given  in  the  table  below.  The  first  block  is  assigned  to  memory 
(see  Section  2.4  below).  The  next  is  unassigned  but  memory  re- 
sponds with  an  invalid  address  indication.  The  last  block  of  64 
words  is  assigned  as  (I/O)  device  register  addresses. 


Address 


Assigned  To 


0000-6143 

6144-8127 

8128-8191 


Memory 

(Unassigned) 

Devices 


DIRECT  DEVICE  ACCESS 


The  high-order  64  addresses  are  assigned  to  devices.  This  provides 
for  direct  device-to-devi ce  or  compute r- to- de vi ce  data  transfers. 
Transfers  occur  on  the  Transfer  Bus  using  signals  and  timing  de- 
tailed above.  Additionally,  devices  must  recognize'  their  address 
and  respond. 


6U5  RtO.  taeer^ 


5EI££ 


o nr\\  \ t B ^ 


10  RO 
lOQ? 


Device  ‘A’  — > 

Uses  bus  'fo  ■/remS'Ter 
; 'A'  VcleaseS 
S£UE  ; '8'  ve^uesls 
bus  Csao)  tthJ 
Veccivfts 
Sc4s  sEUe 


IiEv/«c€  ‘6’ ^ 

monitors  loticj  — 

UiVev\  VCSe^l  B 
coxv^  u.s«  bus. 

'B'  Scfs  logo.  Sit'te 
U ftctcss  «s  noV 

Sxee^Ied  6 VcscH 
bClet  an«I  device 
*C*  now  ve|«ec^ 

CaeQ') 


Flgur*  21.  fomposlte  Bus  Request  and  Transfer  Activity 
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2. 5. 3.4  MEMORY 


2.5.  3.4.2 


The  memory  function  contains  the  v/orking  store,  termed  the  S-Store 
(Stack),  and  the  instruction,  or  I-Store.  The  S-Store  is  a 1024 
word  by  16  bit  read/v;rite  RAM,  and  the  I-Store  is  a 4096  word  read- 
only store.  The  memory  responds  to  read'  and  write  requests  from 
all  devices  attached  to  the  Transfer  Bus  System. 


2.5.3 .4.1  MEMORY  STRUCTURE 


The  CAPS  memory  consists  of  the  storage  module,  containing  a mixture 
of  RAfl  and  ROM;  I/O  gating  for  the  data;  address  decoding  logic; 
control  and  timing  circuitry;  and  RA.M-refresh  timing  logic.  Figure 
22  shews  how  these  functions  are  related.  The  storage  module  is 

covered  in  detail  below;  its  structure  and  circuitry  are  discussed. 
The  cont''ol  provides  read/write/refresh  timing  to  the  storage  module 
and  to  tie  Transfer  bus  interface.  Refresh  interval  timing  is 
required  for  the  dynamic  RAM's  used  in  the  storage  module. 


Figure  2T  is  a map  of  the  storage  module  structure,  showing  data 
word  widths  and  address  assignments.  The  first  1024  words  are 
16  bits  wide  read/write  random  access  store  (RAM).  The  next  block 
of  512  v;ords  is  16  bit  wide  read-only  store  (ROM)  for  storage  of 
program  constants.  The  third  block  of  4096  words  is  8 bits'wide, 
used  for  program  (instruction)  store. 


A group  of  1984  addresses  (6184-8187)  are  unassigned.  An  access 
request  tc  one  of  these  results  in  an  "invalid  address"  indication  - 
a 'fault'  interrupt  to  the  processor.  The  remaining  64  words  are 
reserved  for  assignment  to  I/O  devices  attached  to  the  Transfer 
Bus. 


2. 5.3. 4. 3 MEMORY  ELEMENT  HARDWARE 

Memory  storage  elements  have  been  chosen  with  reliability,  flexibility 
and  power  consumption  as  primary  considerations.  The  1024  word  R.AM 
is  constructed  from  National  Semiconductor  MM4260  1024X1  dynamic 
MOS  RAM's.  These  devices  require  under  100  m.w  per  package  during 
standby.  Their  power  peaks  at  500  mw  only  during  pre-charge.  Duty 
cycle  in  the  flight  director  is  25%  or  less. 

Program  POM  is  constructed  from  512X4  programmable  ROM's  (PROM's). 

Each  PROM  requires  about  600  to  800  mw  in  operation.  Power  swi ton- 
ing is  employed  to  significantly  reduce  power. 


57 


’TkAnif^a  Bos  J»>TCRFAC( 


POWER  SWITCHING 


Without  pov/er  switching,  the  12  PROM's  required  would  dissipate 
(12  X 800)  9.6  max.  Figure  2/t  illustrates  tne  memory  as  con- 
figured for  power  switching.  Three  more  devices  are  required  to  switch 
the  power,  but  power  dissipation  is  significantly  reduced.  The 
switches  turn  the  +5  volt  power  to  the  PROM's  'ON'  only  when 
required  by  an  access  request.  When  OFF,  obviously,  the  PROM's 
consume  no  power.  The  switches,  when  OFF,  require  30  mw  per 
PROM,  When  ON,  a switch  (one  per  PROM)  consumes  100  mw. 

With  power  switching,  when  no  I-Store  access  is  being  made,  I-Store 
power  is  .12  X 30  = 360  mw  (vs  9600  mw). 

Worst-case  active  power  is: 

10  X 30  mw  = 300  mw  (OFF  switches) 

4 X 100  mw  = 400  mw  (ON  switches) 

4 X 800  mw  = 3200  mw  (ON  PROM's) 

3900  mw  maximum 

MEMORY  INTERFACE 

The  memory  module  interfaces  with* the  Transfer  Bus  lines  defined 
earlier.  The  memory  is  a passive  device  in  the  sense  it  can  not 
originate  any  Transfer  Bus  access  requests.  It  can  only  respond. 

Bus  lines  connected  to  the  memory  are  listed  below; 

(S  = Source  D = Destination) 


SB, 

Address  Bus 

D 

DBi 

Data  Bus 

S/D 

IORQ 

Request 

D 

TW 

Reply 

S 

TOwr 

Write  Mode 

D 

De'ven 

Device  'Enable 

S 

FOT 

Reset 

D 

CLK8A 

8 MHz  Clock 

D 

Tmr 

Invalid  Address 

S 

?.5.3.^.6  MEMORY  TIMING 

All  timing  in  the  memory  is  derived  from  dnd  synchronous  v/ith  the 
8 MHz  clocK.  A four-state  "counter"  governs  sequencing  of  read 
and  write  cycles.  Figure  ?s  shows  the  "counter"  sequencing 
' for  a RAM-read  and  write  and  for  a ROM-read. 

The  four  counter  states  are  labeled  A,  B,  C and  D.  The  dotted  lines 
in  the  top  diagram  show  now  the  cycle  is  extended  in  case  of  a 
'write'.  The  lower  diagram  is  for  an  I-Store  read. 

In  the  case  of  a PAM  access,  state  'A'  corresponds  to  the  precharge 
pulse  to  the  RAM  components.  State  ‘O'  drives  the  write  pulse  if 
'write'  is  commanded. 

RAM  refresh  cycles  occurr  at  about  30  p-sec  intervals.  This  is 
necessary  to  insure  that  all  cells  in  the  RAM  (32  columns)  are 
refreshed  at  least  once  per  millisecond.  A refresh  cycle  is 
equivalent  to  a write  cycle. 

2.5.  3.4.7  POWER  REQUIREMENTS 

The  memory  requires  +5  and  -12  volts  DC  nominal.  Specifically: 

+5  VDC  _+  0.2V,  100  mv  P-P  ripple  max. , 

(approx.  4.0  W) 

-12  VDC  j^O.SV,  100  mv  P-P  ripple  max., 

(approx.  2.5W) 

The  power  figures  are  subject  to  change. 

2.53.5  INTERRUPTS 

The  DFDC  utilizes  the  following  interrupts: 


Machine  Generated 

- Halt  (Program  initiated) 

- Illegal  Address 

- illegal  Opcode 


I^/0_  Genor  jted 

- Time  pnase  a 

- Time  phase  b 

- Data  ready 

Tne  number  of  interrupts  can  be  expanded  externally.  Interrupts 
are  scanned,  masked,  serviced  and  reset  under  both  microprogram 
and  software  control. 
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2.b.3.e  INSTRUCTION  SET 

2. 5. 3. 6.1  INSTRUCTION  FORMAT 

The  basic  instruction  format,  as  shown  in  Figure  26  is 
an  eight  bit  syllable.  Three  classes  of  instruation  exist. 

A.  Literal  Syllable  ,1  instruction 

A six  bit  literal  is  embedded  with  this  eigit-bit 
syllable  in  the  least  six  significant  bit'pckitions. 

Bits  6 and  7 designate  this  instruction  wi'.thi encoding 

of  00.  \ 

B.  Local  Environment  Syllable  4 Instructions 

This  eight-bit  syllable  is  the  only  syllable  kaving 
ONE  in  bit  7 (the  most  significant  bit  of  the  syllable). 

The  instruction  syllable  can  best  be  described  by 
reference  to  Figure  26. 

Bit  6 indicates  whether  the  syllable  is  reference  or 
assign  operation.  Bit  5 indicates  double  or  single 
word  operation.  The  remaining  five  bits  are  used  as 
an  index,  relative  to  the  bas'e  address  stored  in  the 
LENV  (Local  Environment  Pointer),  of  a word  in  the 
local  environment.  The  computed  address  (addition  of 
LENV  and  the  five-bit  index  in  the  Local  Environment 
Syllable)  points  to  either  the  desired  v;ord  of  a 
single  word  or  the  first  (least  significant)  word  of 
a double  word  format. 

C.  Operator  Syllable  64  Instructions  (Max. 

This  eight-bit  syllable  is  detectable  by  encoding  of 
bits  7 and  6 as  ZERO  and  ONE.  The  operation  field  of 
six  bits  (bits  0 thru  5)  utilizes  binary  combinations 
of  six  bits  to  designate  a specific  instruction  within 
its  class.  The  specific  assignment  of  binary  code  to 
an  instruction  is  arbitrary.  In  this  class  of  syllable 
there  are  no  index  oits,  address  bits,  or  literal  bits 
embedded  in  the  8 bits  of  the  syllable. 
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7 6 5 4 3 2 1 0 


0 

0 

Literal  (6  bits) 

1 

Reference  and  Assignment  to  Local 
Environment  (7  bits) 

0 

1 

Operation  Field  (6  bits) 

INSTRUCTION  FORMAT 


Bit  position 


Literal  Syllable 


Local  Environnent 
Syllable 


Operator  Syllable 


(5  bits) 


Reference  Local 
Environment  Single 
Word 


1 0 


^5  bits) 


Reference  Local 
Environnent  Double 

Word 


1 

1 0 

(5  bits) 

1 

i ’ 1 ^ 

5 bits) 

Fif»urel26.  Form.it  of  l.ocal  Fnvironmcnt 
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Assign  to  Local 
Environment  Single 

Word 


Assign  to  Local 
Environment  Double 

Word 


Syllahle 


2. 5.3. 6. 2 INSTRUCTION  DEFINITION 


A definition  and  description  of  instructions  for  the  Digital 
Flight  Director  Processor  follows. 

2. 5.3.6. 2.1  REFERENCE  AND  ASSIGN  OPERATIONS 


Literal  2 Instructions 

LIT  [K]  6 Bit  Literal 

LITS  [K]  16  Bit  Literal 


The  zero  address  architecture  of  the  machine  causes  frequent 
requirement  for  constant  values  to  be  used.  The  fastest 
access  to  these  is  directly  from  the  code  stream.  The  literal 
operations  provide  this  capability. 

Local  Environment  Relative  5 Instructions 


LOCL  (I) 

REFLS  [K] 

ASNLS  ([K],V) 
REFLD  [K] 
ANSLD  ([K],V) 


Global  relative  address  of  local  word. 
Reference  local  environment  single  word. 
Assign  to  local  environment  single  word. 
Reference  local  environment  double  word. 
Assign  to  local  environment  double  word. 


The  most  frequently  occuring  operations  should  involve  refer- 
ences and  assigns  to  local  environment.  References  and  assign- 
ments v/ith  single  and  double  words  of  the  local  environment  can 
be  made  with  a single  syllable. 


Absolute 


4 Instructions 


REFAS  (I) 
ASNAS  (V,I) 
REFAD  (I) 
ASNAD  (VM) 


Reference  absolute  single  v/ord. 
Assign  absolute  single  word. 
Reference  absolute  double  word. 
Assign  absolute  double  word. 


Absolute  references  and  assignments  allow  access  to  input,  output 
devices  and  global  environment  of  main  memory. 


Autoindexing 


5 Instructions 


REFXS  (I) 
ASNXS  (V,I) 
REFXD  (I) 
ASNXD  (V',I) 
DCT  (I) 


Indirect  reference  single  and  increment  index 
Indirect  assign  single  and  increment  index. 
Indirect  reference  double  and  increment  index 
Indirect  assign  double  and  increment  index. 
Decrement  counter  and  test. 


66 


w 


These  instructions  are  used  for  indirect  accessing  and  storage 
of  single  and  double  v/ora  auantities  indirectly  through  index 
registers.  A decrercent  and  test  instruction  provides  a counting 
capability  with  iterative  control. 

Stack  2 Instructions 

DUPS  (V)  Duplicate  top  of  the  stack  single  v/crd. 

DUPD  (V)  Duplicate  top  of  the  stack  double  v/ord. 

2.5. 3.6. 2. 2 These  stack  manipulation  operations  are  useful  for  nondestructive 
assignments  and  other  machine  level  macros. 

CONTROL  OPERATIONS 


Transfer 


3 Instructions 


SKIP  (N) 
IFT  (C.N) 
IFF  (C,N) 


Unconditional  skip  N syl labels. 

If  condition  TRUE,  continue,  else  skip. 
If  condition  FALSE,  continue,  else  skip. 


The  control  transfer  operators  unconditionally  or  conditional! 
alter  the  contents  of  tne  program  syllable  count  register  (SFC 
They  are  designed  so  that  all  labels  appear  as  SPCR  relative 
addresses  in  the  code. 


Subroutine  and  Block 


4 Instructions 


CALL  (XI XN,N,F) 

RETURN 

BEGIN*  (XI.... XN) 

END 


Call  subroutine. 

Return  from  subroutine. 
Block  begin. 

Block  end. 


The  subroutines  make  use  of  process  stack  to  store  their  actual 
parameters,  return  values,  and  local  variables.  Consequently 
recursive  routines  are  primitive  to  this  machine.  The  BEGIN 
instruction  places  an  arbitrary  number  of  values  in  the  accumu- 
lator region  of  stack  into  the  local  environment  region  of  the 
stack.  Tne  END  instruction  complements  BEGIN  instruction. 


Loop 


3 Instructions 


SVSKIP  (N) 
LOOPT  (L,C) 
LOOPF  (L.C) 


Save  current  SPCR  and  skip  N-syllable. 
Loop  on  condition,  true. 

Loop  on  condition  false. 


The  interative  control  operations  provide  several  specialized 
forms  of  loop  control.  Instruction  SVSKIP  can  be  used  with 
control  transfer  operations  to  form  other  iterative  controls. 
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Interrupt 


1 Instruction 


INTRTN 

HALT 


Interrupt  return  (executed  in  interrupt  r.ode) 
Interrupt  mode  entry  (executed  in  user  mode) 


The  function  of  the  INTRTN'/HALT  instruction  is  dependent  upon  the 
mode  (interrupt  mode  or  user  mode)  at  the  time  of  execution.  If 
executed  v/hile  the  machine  is  in  the  interruot  mode,  the  function 
is  that  of  interruot  return;  that  is,  the  return  of  control  state 
to  some  user  mode  program.  If  the  instruction  is  executed  v/hile 
the  machine  is  in  user  mode,  the  HALT  function  allows  suspension 
of  the  current  user  mode  program  and  mode  transfer  to  the  interrupt 
mode. 


2.5.3. 6. 2. 3 


2 .5.3, 6. 2. 4 


ARITHMETIC  OPERATIONS 


TWOs  complement  fractional 


4 Instructions 


ADD  (X,Y) 
SUB  (X,Y) 
(X,Y) 


MPY 


DIV  (X.Y) 


TWOs  complement  add. 

TWOs  complement  subtract. 
TWOs  complement  multiply. 
TWOs  complement  divide. 


Extended  precision  TWOs  complement  fractional 


EADD  (R,X,Y) 
ESUB  (R,X,Y) 
SMPY  (R,X,Y) 
EDIV  (R,X,Y) 


LOGICAL  AND  RELATIONAL  OPERATIONS 


Boolean 


1 Instruction 


BOOL  (X.Y.N) 
Relational 


Bit  by  bit  Boolean  function  N, 

2 Instructions 


GR  (X,Y) 
EQ  (X.Y) 


TWOs  complement  fraction  greater  than. 
TWOs  complement  fraction  equal. 


Test  and  Set 


3 Instructions 


SET  (S.I) 


RESET  (S,I) 


TRIB  (S) 


Test  and  set  bit. 

Test  and  reset  bit. 

Test  and  reset  interrupt  bit. 


The  SET  and  RESET  operations  allow  a bit  from  an  absolutely 
addressed  word  (including  any  register)  to  be  explicitly  read 
left  in  a particular  state.  The  ope'"ation  TRIB  can  be  used 
only  with  the  Interrupt  Register. 
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2.5. 3. 6. 2. 5 manipulative 

XTRACT  (X,S,L)  Extract  field  from  word. 

INSERT  (X.Y.X.L)  Insert  field  in  word. 

These  two  instructions  permit  partial  word  operations  of  a 
continuous  group  of  bits  in  a word  treated  as  a ring. 


Ftsfiire  27.  Proj^rnm  Ctmf  1 p,urat  Ion 


X IkJTRTN 

XX  INTERRUPTS  (EXTERNAL  OR  HALT) 
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INTERRUPT  HANDLING 

There  are  two  modes  of  processing  in  the  machine,  the  interrupt 
mode  and  user  mode.  The  machine  normally  operates  in  user  mode. 

When  an  interrupt  condition  is  generated,  either  externally  or 
internally,  interrupt  processing  is  indicated.  An  interrupt 
mask  register  is  used  to  indicate  which  interrupts  are  recognized. 

Figure  27  shows  the  program  configuration  in  the  machine.  Each 
program  is  described  by  its  own  code  descriptor  and  stack  descriptor. 
Control  can  be  transferred  from  one  program  to  the  other  via  interrupt 
and  interrupt  scheduler  program.  Queuing  of  interrupts  is  done  in 
the  interrupt  scheduler  program,  in  the  interrupt  mode.  The  interrupts 
are  serviced  in  the  user  mode.  Since  the  interrupt  scheduler  program 
is  executed  frequently,  it  is  desirable  that  the  interrupt  scheduler 
be  a short  program. 


2. 5.3. 6. 3.1  Sequence  of  Interrupt  Handling 

The  sequence  of  interrupt  handling  can  best  be  described  by  reference 
to  Figure  28. 


USER  STACK 


USER 

I PROGRAM 
l(USER  MODE) 


INTERRUPT  STACK 


INTERRUPT  "A 


INTERRUPT 

SCHEDULAR 

PROGRAM 

(INTERRUPT 

MODE) 


INTERRUPT  SERVICE  A 
STACK 

HALT  INTERRUPT  (4) 


INTRTN 


INTERRUPT 

SERVICE 

PROGRAM 

(USER 

MODE) 


FiRuro  28.  Interrupt  HancninR  Sequenrji 


Notes:  (1)  User  stack  is  active  when  interrupt  A is  recognized 
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Recognition  of  interrupt  activates  the  interrupt  stack,  and  user 
stack  is  suspended. 

Stacks  ve  shovm  before  and  after  recognition  of  interrupts 


Interrupt  Stack  User  Stack 


Stacks  before  interrupt  recognition 


(2)  Interrupt  scheduler  program  identifies  and  processes  the 
the  received  interrupt. 

(3)  Execution  of  INTRTN  instruction  transfers  control  to 
interrupt  A service  program.  Interrupt  stack  is  suspended 
and  interrupt  A service  stack  is  activated. 


Interrupt  Stack 


Interrupt  A Service  Stack 


L 


i: 

J 
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(4)  After  interrupt  A service  program  is  complete  halt  instruction 
is  executed.  This  generates  halt  interrupt.  The  control  is 
transferred  to  interrupt  scheduler  program.  'Interrupt  A' 
service  stack  is  suspended. 

Interrupt  Stack  Interrupt  A Service  Stack 


Stacks  before  execution  of  halt 
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(5)  Halt  interrupt  is  processed. 

(6)  Execution  of  user  program  is  resumed.  Interrupt  stack  is 
suspended. 


Stacks  before  execution  of  IflTERTN 


Stacks  after  execution  of  INTRTN 
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2.6  Self  Test 

Initiation  of  the  Self  Test  Mode,  either  by  the  external 
28  volt  discrete  signal  or  the  front  panel  pushbutton  causes 
the  DFDC  to  perform  internal  tests  which  evaluate  the 
integrity  of  the  unit.  These  tests  are: 

1)  Deflection  of  the  Vertical  and  Horizontal  pointers 
one  quarter  inch  to  the  right  and  one  quarter  inch 
down.  The  outputs  are  forced  to  this  position  by 
the  computer.  The  output  signals  are  multiplexed 
to  the  A to  D converter,  digitized  and  interrogated 
for  positional  accuracy. 

2)  Two  self- test  constants  are  requested  from  the 
analog  multiplexer  and  compared  with  constants 
stored  within  the  computer  to  test  the  I/O  con- 
trol logic,  analog  multiplexer,  and  DFDC  bus 
system. 

3)  Execution  of  basic  arithmetic  and  reference/ 
assign  operations. 

4)  Program  sequencing. 

When  the  DFDC  is  not  in  the  self  test  mode  certain  monitor 
functions  are  performed: 

1)  A check  to  determine  that  computations  have  been 
completed  in  the  time  allotted. 

2)  The  occurrence  of  invalid  addresses  or  op  codes. 

3)  Power  supply  voltages  tolerance  checks. 

Incorrect  operation  during  any  of  these  tests  results  in 
actuation  of  the  front  panel  failure  annunciator  and  a high 
impedance  state  at  the  DFDC  valid  output.  The  failure 
annunciator  may  be  reset  by  initiating  the  self  test  mode 
once  the  fault  has  cleared.  A multivibrator  has  been  pro- 
vided on  the  A4  card  assembly  to  insure  that  the  DFDC  re- 
mains in  the  self  test  miode  for  300  msec  to  complete  all 
required  tests. 


I 
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2.7 


Power  Requirements 


The  DFDC  operates  from  single  phase  115V  400  HZ  aircraft  pov/er. 
Power  supply  design  ensures  operation  from  105  to  125V  and  320 
to  480  HZ.  The  unit  dissipates  53.2  watts  distributed  as 
fol lows : 


Card  Assembly 

Power  (Watts) 

A1 

.005 

A2 

.425 

A3 

1.515 

A4 

3.721 

A5 

1.390 

A6 

1.375 

A7 

3.610 

A8 

3.395 

A9 

3.800 

AlO 

3.675 

All 

4.070 

Card  Total 

27.081 

Power  Supply 

26.12 
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Power  Converter 


Three  series  regulators  implemented  with  monolithic  devices 
provide  +15,  -15,  and  -12V.  Each  supply  will  continously 
output  40?^  more  current  than  is  required  for  the  Digital 
Fliqht  Director.  The  addition  of  short  circuit  protection 
and  foldback  current  limiting  insures  that  these  supplies 
will  survive  under  the  most  adverse  operating  conditions. 

A switching  regulator  provides  +5  volt  logic  power.  This 
unit  normally  operates  at  4.5  amps  and  is  capable  of 
supplying  7.5  amps  continuously.  Short  circuit  protection 
is  implemented  by  limiting  the  series  switch  duty  cycle  to 
90%. 

Power  supply  design  specifications  are  listed  below: 


Output  Current 


Normal  Operation  Maximum  Capability  Requl ati on 


+5V 

4.5  amps 

7-5  amps 

2% 

+ 15 

180  ma 

250  ma 

n 

-15 

100  ma 

250  ma 

1% 

-12 

135  ma 

500  ma 

1% 

-5 

40  ma 

100  ma 

2% 
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The  DFDC  is  contained  in  an  ARINC  one-half  ATR  short  rack 
(MIL-C-172C  case).  Case  dimensions  are  shov;n  in  Figure  29. 

The  unit  consists  of  eleven  electronic  multilayer  card  assemblies  and 
a rear  mounted  power  converter.  A sidemounted  multilayer  planar 
interconnect  contains  130  connector  pins  for  each  of  the  card  assem- 
blies. Two  front  mounted  100  pin  connectors  are  hard  wired  to  the 
planar  interconnect.  Unit  weight  is  13.3  lbs. 


I 
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Control  Drawing 


2.10 


Airspeed  Control ler 


The  377B-1  Air  Speed  Controller  (ASC)  provides  node  control,  air- 
speed input  data,  beam  sensor  overrides,  and  airspeed  input  selec- 
tion to  the  DFDC.  Outside  dimensions  of  the  ASC  are  illustrated  in 
Fiaure  30. 

DFDC  mode  control  is  provided  by  a five  position  rotary  switch. 

A spring  return  in  the  test  mode  returns  the  switch  to  the  OFF  mode 
when  released.  Manually  set  airspeed  is  displayed  on  three  10  digit 
rotary  displays.  Airspeed  range  is  0 to  840  knots.  By  setting  the 
Lateral  and  Vertical  Beam  Sensor  Override  (LBS  and  VBS)  toggle  switches 
to  ON  the  pilot  can  force  early  capture  of  the  localizer  and  glide- 
slope  radio  beams.  Airspeed  inputs  to  the  DFDC  are  selected  by  the 
MAS  CAS  toggle  switch  (Manual  Airspeed,  Computed  Airspeed). 

The  ASC  front  panel  is  edge  lit  to  provide  illumination  of  switch 
labels  and  airspeed  readout.  An  electrical  diagram  of  the  ASC  is 
shown  in  Figure  31. 
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$lMA  'l»<AT>-i95. 


Figure  30.  ASC  Install.itlon  Control  Drawing 


2. n Aircraft  Interconnect 

Connection  of  the  Digital  Flight  Director  Computer  to  the  Air 
Speed  Controller  and  other  aircraft  systems  is  accomplished  through 
a 100  pin  front  mounted  connector  designated  Jl.  02,  a 100  pin  test 
connector,  is  also  provided  on  the  front  panel.  Signal  locations  on 
01  and  02  are  shown  in  Figures  32  and  33.  Characteristics  of 
the  input/output  signals  are  described  in  Figures  34  and  35. 

The  DFDC  cable  interface  is  illustrated  in  Figure  36. 
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PIH 

SIGNAL 

PIN 

SIGNAL 

1 

SPARE 

SI 

COMPUTED  AIR  SPEED  ♦ 

2 

SPARE 

52 

COM’UTED  AIR  SPEED  - 

3 

SPARE 

S3 

MANUAL  AIR  SPEED  ♦ 

4 

SPARE 

54 

MANUAL  AIR  SPEED  • 

5 

SPARE 

55 

♦12  VDC 

6 

SPARE 

56 

SPARE  ■ 

7 

SPARE 

57 

PITCH  Y 

8 

SPARE 

58 

PITCH  X 

9 

HEADING  ERROR  H 

59 

PITCH  Z 

10 

HEADING  ERROR  C 

60 

HORIZONTAL  POINTER  + 

11 

LATERAL  (HSI)  DEV  FLAG  + 

61 

HORIZONTAL  POINTER  - 

12 

LATERAL  (HSI)  DEV  FLAG  - 

62 

ILS  MODE 

13 

GLI DESLOPE  FLAG  + 

63 

TAC  MODE 

14 

GLIOESLOPE  FLAG  - 

64 

RADAR  ALTIMETER  VALID 

15 

SPARE 

65 

RADAR  ALTIMETER  COMMON 

16 

SPARE 

66 

POWER  COMMON 

17 

ERROR  REFERENCE  H 

67 

SPARE 

18 

ERROR  REFERENCE  C 

68 

LOCALIZER  DEVIATION  + 

19 

VERTICAL  POINTER  FLAG 

69 

LOCALIZER  DEVIATION  - 

20 

HORIZONTAL  POINTER  FLAG 

70 

LATERAL  (HSI)  DEV  OUTPUT  + 

21 

GLIDE  PATH  ENGAGE 

71 

LATERAL  (HSI)  DEV  OUTPUT  - 

22 

FLIGHT  DIRECTOR  VALID 

72 

MANUAL  HEADING 

23 

SELF  TEST 

73 

RADAR  ALTITUDE  + 

24 

+28  VDC 

74 

RADAR  ALTITUDE  - 

25 

SPARE 

75 

LOCALIZER  FLAG  - 

26 

COURSE  ERROR  H 

76 

SPARE 

27 

COURSE  ERROR  C 

77 

SPARE 

28 

DME  HUNDREDS  X 

78 

TAC  DEVIATION  + 

29 

CME  HUNDREDS  Y 

79 

TAC  DEVIATION  - 

30 

SPARE 

80 

VERTICAL  POINTER  + 

31 

VBS  OVERRIDE 

81 

VERTICAL  POINTER  - 

32 

LBS  OVERRIDE 

82 

TAC  FLAG  + 

33 

SPARE 

83 

TAC  FLAG  - 

34 

SPARE 

84 

LOCALIZER  FLAG  ♦ 

35 

SPARE 

85 

SPARE 

36 

Olt  UNITS  X 

86 

SPARE 

37 

DME  UNITS  Y 

• 87 

GLIOESLOPE  DEV  - 

38 

DME  TENS  X 

88 

GLI  DESLOPE  DEV  + 

39 

DME  TENS  Y 

89 

GLIOESLOPE  DEV  OUTPUT  + 

40 

SPARE 

90 

GLIOESLOPE  DEV  OUTPUT  - 

41 

AIR  SPEED  SELECT 

91 

GLIOESLOPE  FLAG  OUT  + 

42 

AIR  SPEED  REFERENCE  + 

92 

GLIOESLOPE  FLAG  OUT  - 

43 

AIR  SPEED  REFERENCE  - 

93 

ADI  COMMON 

44 

SPARE 

94 

SHIELD  GROUND 

45 

115  VOLTS  400  HZ 

95 

SPARE 

46 

ROLL  (BANK)  X 

96 

SPARE 

47 

ROLL  (BANK)  Y 

97 

SPARE 

48 

ROLL  (BANK)  Z 

98 

SPARE 

49 

DME  REFERENCE  H 

99 

SPARE 

50 

DME  REFERENCE  C 

100 

CHASSIS  GROUND 

FlRure  32.  J1  - Signal  Connector 


J 


PIN 

SIGNAL 

1 

SPARE 

2 

SPARE 

3 

SPARE 

4 

SPARE 

5 

SPARE 

6 

PCOS 

7 

PSIN 

8 

RCOS 

9 

RSIN 

10 

RHSIN 

11 

RHCOS 

12 

RTS  IN 

13 

RT  COS 

14 

GS 

15 

LOC 

16 

TAC 

17 

RALT 

18 

CAS 

19 

GS  FLG 

20 

LOC  FLG 

21 

TAC  FLG 

22 

REFAS 

23 

EOC 

24 

THETAHE 

25 

THETACE 

26 

OFFF 

27 

ILSF 

28 

FIRESET 

29 

FISET 

30 

STC1 

31 

STC2 

32 

CLK8M 

33 

POC 

34 

PWROUTF 

35 

CLK.5M 

36 

CLK.25M 

37 

T1 

38 

T2 

29 

lOINT 

40 

SROE 

41 

ODA 

42 

CON  VI 

43 

SAH 

44 

LDIS 

45 

P5V 

46 

N5V 

47 

P15V 

48 

N15V 

49 

N12V 

50 

D8I9I3F 

figure  33. 


PIN  SIGTJAL 


51 

0601 F 

52 

0B02F 

53 

0603F 

54 

D804F 

55 

DBOSF 

56 

DB06F 

57 

060  7F 

58 

0B08F 

59 

DB09F 

60 

DB10F 

61 

0B11F 

62 

DB12F 

63 

DB13F 

64 

081 4F 

65 

0B15F 

66 

ABOOF 

67 

A601F 

68 

AB02F 

69 

AB03F 

70 

AB04F 

71 

A605F 

72 

AB06F 

73 

AB07F 

74 

AB08F 

75 

AB09F 

76 

AB10F 

77 

ABllF 

78 

AB12F 

79 

BRQF 

80 

SZBF 

81 

6G0 

82 

BG1 

83 

BG2 

84 

lORWF 

85 

MINT 

86 

lORQF 

87 

lORPF 

88 

SPARE 

89 

DEVENF 

90 

SPARE 

91 

SPARE 

92 

UM 

93 

DMARQ  • 

94 

INT8 

95 

SPARE 

96 

REFRSF 

97 

SPARE 

98 

GND 

99 

SPARE 

100 

SGNO 

J2  - Teal  Connector 
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DIGITAL  FLIGHT  DIRECTOR  INPUT  SIGNAL 
INTERFACE  CHARACTERISTICS 


SIGNAL 

PINS 

INTERFACING 

SIGNAL 

APPLICABLE 

SYSTEM 

CHARACTERISTICS 

SPECIFICATION 

1 

HEADING 

31-9  H 

HSI 

0-11  VAC 

MIL  I 83034A 

ERROR 

J1-10  C 

Referenced  to  3 

Figure  4 

2 

COURSE 

J1-26  H 

HSI 

0-11  VAC 

MIL  I 83034A 

ERROR 

J1-27  C 

Referenced  to  3 

Figure  4 

3 

ERROR 

J1-17  H 

HSI 

26  VAC 

MIL  I 83034A 

REFERENCE 

31-18  C 

Figure  4 

4 

ROLL  (BANK) 

31-46  X 

Roll  Gyro 

3 wire  synchro 

MIL  C 83014A 

31-47  Y 

Figure  4 

31-48  Z 

. 

5 

PITCH 

31-57  X 

Pitch  Gyro 

3 wire  synchro 

31-58  Y 

31-59  2 

6 

DME  HUNDREDS 

31-28  X 

DME  Receiver  or 

3 wire  synchro 

MIL  I 83034A 

31-29  Y 

HSI 

2 leg  connected 

Para.  3.23.1 

to  common  31-50 

Figure  4 

7 

OME  TENS 

31-38  X 

DME  Receiver  or 

3 wire  synchro 

MIL  I 83034A 

31-39  Y 

HSI 

Z leg  connected 

Para.  3.23.1 

- 

to  common  31-50 

Figure  4 

8 

DME  UNITS 

31-36  X 

DME  Receiver  or 

3 wire  synchro 

MIL  I 83034A 

31-37  Y 

HSI 

2 leg  connected 

f^ara.  3.23.1 

to  common  31-50 

Figure  4 

9 

OME  REFERENCE 

31-49  H 

OME  Receiver  or 

Synchro  reference 

MIL  I 83034A 

31-50  C 

HSI 

Para.  3.23.1 

Figure  4 

10 

LOCALIZER 

31-68 

ILS  Receiver 

+15Qua  ■ +2“ 

MILC  8301 4A 

DEVIATION 

31-69  - 

Tin  « iKn 

11 

GLIDESLOPE 

31-87  + 

ILS  Receiver 

+15Qua  = +0.7" 

MIL  C 83014A 

DEVIATION 

31-88  - 

Tin  * IKn 

12 

TACAN 

31-73  + 

TACAN  Receiver 

+15Qya  = +10* 

MIL  C 83014A 

DEVIATION 

31-79  - 

Tin  = iKn 

13 

RADAR  ALTITUDE 

31-74  + 

-40  VDC/1000  ft 

31-73  - 

14 

COMPUTED  AIR 

31-51  ♦ 

AIR  DATA  COMPUTER 

12  VOC/840  kts 

Statement  of 

SPEED 

31-52  - 

V 

AIRSPEED 

31-42  + 

AIR  DATA  COMPUTER 

12  VDC 

Statement  of 

REFERENCE 

31-43  - 

rigur*  34.  DFDC  Input  Signal  Characterlaticn 
(Page  1 of  2) 
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SIGNAL 

PINS 

INTERFACING 

SYSTEM 

SIGNAL 

CHARACTERISTICS 

APPLICABLE 

SPECIFICATION 

16 

'1ANUAL 

.^IRSPEEO 

01-53  ♦ 
01-54  - 

Airspeed 

Controller 

12  VDC/840  kts 

Statement  of  i 

17 

POWER 

POWER  COMMON 

01-45  H 
01-66  C 

115  VAC  400  HZ 
Single  Phase 
1.5  VA 

MIL  STD  704A 

18 

♦28  VOC 

01-24 

0.1  VA 

MIL  STD  704A 

19 

CASE  GROUND 

01-10 

20 

SELF  TEST 

01-23 

Airspeed 

Controller 

28  VOC  - ON 
0 VDC  - OFF 

21 

GLIDESLOPE 

FLAG 

01-13  + 
01-14  - 

ILS  Receiver 

ISQiia  In  View 
255pa  Out  of  View 
21n  * IKfl 

MIL  C 8301 4A 

22 

LOCALIZER 

FLAG 

01-84  ♦ 
01-75  - 

ILS  Receiver 

180;ua  In  View 
25^id  Out  of  View 
21n  •=  iKfl 

MIL  C 8301 4A 

23 

TACAN 

FLAG 

01-82  + 
01-83  - 

TACAN  Receiver 

18Qua  In  View 
255;ua  Out  of  View 
Zin  * IKn 

MIL  C 8301 4A 

24 

lADAR  ALTITUDE 
VALID 

01-64 

Radar  Alt  Rcvr 

0 VOC  Invalid 
S VOC  Valid 

MIL  C 83014A 

25 

VBS 

OVERRIDE 

01-31 

Ai  rspeed 
Controller 

0 VDC  Off 
28  VDC  On 

NIL  C 8301 4A 

26 

LBS 

OVERRIDE 

01-32 

Ai rspeed 
Controller 

0 VDC  Off 
28  VOC  On 

MIL  C 8301 4A 

27 

AIRSPEED 

SELECT 

01-41 

Airspeed 

Controller 

0 VDC  - Comp,  AS 
’ 28  VDC  - Manual  AS 

28 

KAN  HOG 
MODE 

01-72 

Ai rspeed 
Controller 

0 VDC  Off 
28  VDC  On 

29 

TAC  MODE 

01-63 

Ai rspeed 
Controller 

0 VDC  Off 
28  VDC  On 

30 

ILS  MODE 

01-62 

Airspeed 

Controller 

0 VDC  Off 
28  VOC  On 

figure  34.  D'n)C  Input  Signal  Characteristics 
(Page  2 of  2) 
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DIGITAL  FLIGHT  DIRECTOR  OUTPUT  SIGNALS 
INTERFACE  CHARACTERISTICS 


SIGNAL 

PINS 

INTERFACING 

SIGNAL 

APPLICABLE 

SYSTEM 

CHARACTERISTICS 

SPECIFICATION 

1 

VERTICAL  POINTER 

Jl-80  ♦ 

ADI 

♦2.2ma-» +23® 

MIL  C 8301 4A 

J1>81  - 

7|2ma  Out  of  View 
2l  ■ 500n-»lKn 

2 

HORIZONTAL 

Jl-60  + 

ADI 

♦2.2ma  *23<> 

MIL  C 83014A 

POINTER 

J1-61  - 

7l2ma  Out  of  View 
Z|_  ■ 500n-»lKn 

3 

LATERAL 

Jl-70  ♦ 

HSI 

MODE  SIGNAL 

MIL  C 8301 4A 

DEVIATION 

Jl-71  - 

CFF^  TAC  DEV 
TAC  TAC  DEV 
ILS  LOC  DEV 

4 

GLIDESLOPE 
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DFRC  Fxtemal  Wiring  Diagram 


2.12  Applicability  to  Mass  Production 


Prior  to  iiardv/aro  design  of  tbo  prototype  computers,  guidelines  v/erc 
eslabl  isiied  to  minimize  niodi  f iraf  iotis  required  to  produce  preproduction 
units  of  the  b62A-14.  To  this  end,  the  follov/ing  items  were  completed: 

1)  The  unit  was  designed  to  meet  the  necessary  mecfianical,  electrical 
and  environmental  requirements  of  MIL-C-83014A. 

2)  A complete  set  of  configuration  control  drawings  and  list  of  materials 
was  prepared. 

3)  Electronic  components  were  selected  from  off-the-shelf  high  usage 
items  to  insure  availability  for  production  quantities. 

4)  Ruggedized,  multilayer  planar  circuit  cards  were  selected  for  card 
assemblies  and  the  side  plane  interconnect. 

Although  production  design  and  fabrication  requirements  were  imposed  on  the 
DFDC,  prior  to  cominiting  the  unit  in  its  present  form  to  mass  production 
tv/o  alternatives  to  the  present  configuration  should  be  considered. 

1)  Processor  technology  at  Collins  has  advanced  to  the  stage  where  the 
present  DFDC  package  size  and  pov/er  requirements  will  support  a pro- 
cessor of  three  times  the  DFDC  CAPS-2  processor  throughput  capability 
(120,000  operations  per  second).  By  utilizing  Collins  state-of-the-art 
CAPS-4  processor  in  the  present  DFDC  configuration  flight  director  ver- 
satility could  be  expanded  to  provide  additional  mode  capability.  Attitude 
hold  with  pitch  synchronization  could  then  be  implemented  utilizing 

the  present  aircraft  systems  interface.  Additional  inputs  from  the 
Digital  Air  Data  Computer  would  make  possible  implementation  of  altitude, 
vertical  speed,  and  airspeed  hold  mode  commanjs  through  the  pitch  steering 
pointer.  The  CAPS-4  processor  is  presently  being  utilized  at  Collins  to 
perform  autoland  computations  in  a dual  fail  passive  autopilot  system. 

2)  The  second  alternative  is  a reduction  of  DFDC  size  power  and  v/eight. 

An  investigation  of  state-of-the-art  component  advances  since  the 
design  of  the  DFDC  was  undertaken  toward  this  end.  Since  the  processor 
requires  the  most  space,  pov;er  and  therefore  weight  this  function  should 
be  the  first  candidate  for  replacement.  The  possibility  of  utilizing 

an  mos  microorocessor  has  been  considered.  However,  DFDC  processor  speed 
requirements  have  not  yet  been  achieved  by  microprocessors. 

Basic  to  the  circular  capture  control  law  is  range  estimation  which 
requires  a Kalman  filter  or  a filtering  technique  of  comparable  com- 
plexity. Acceptable  performance  requires  a data  update  rate  of  ton  per 
second.  These  tv/o  requirements  necessitate  a digital  processor  capable 
of  performing  nearly  100,000  operations  per  second.  Present  state-of-the- 
art  microprocessor  approach  10,000  operations  per  second  - far  below  what 
is  required. 

Until  the  speed  of  mos  microprocessors  is  near  100,000  operations  per 
second,  it  appears  tfic  best  candidote  for  a production  DFDC  would  contain 
a CAPS-4  computer  assigned  additional  tasks. 
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SECTION  III 


Control  Law  Design  ^nd  Analysis 

Section  3.0  provides  detailed  analytic  results  that  have  evolved 
during  the  developrent  and  support  phases  of  the  Digital  Flioht 
Director  Computer  (OFOC)  orogram.  Paragraph  3.I  provides  a dis- 
cussion of  the  concepts  involved  in  the  circular  capture  algorithm. 

The  circular  capture  algorithm  includes  the  circular  capture  of  the 
radio  beam  to  be  acquired,  the  wind  estimation,  and  the  estimation 
of  the  aircraft  ground  velocity.  This  discussion  will  use  variables 
presented  in  the  originally  proposed  circular  capture  algorithm  as 
Illustrated  in  Figure  44.  The  symbols*  will  be  presented  as 
scripted  characters**  where  a ' indicates  the  best  estimate  of  a 
variable  and  a ' indicates  the  predicted  value  of  that  variable. 

The  symbols  are  defined  in  Table  3.1.  The  standard  aircraft  distance 
and  angle  definitions  are  illustrated  in  Figure 37  . The  basic 
geometric  relationships  for  ILS  localizer  and  glideslope  are  illus- 
trated in  Figure  38  and  39  , respectively.  The  algorithm  imple- 
mented involves  three  types  of  variables  --  measured,  predicted,  and 
estimated.  A recognition  of  the  distinction  between  these  is 
crucial  to  an  understanding  of  the  multistage  decision  process 
Involved  in  the  control-estimation  process.  Basically,  certain 
variables  can  be  measured  such  as  (^o)k,  B,.,  Like  all  real 
world  measurements,  these  are  imperfect  either  due  to  corrupting 
noise  or  imperfect  measurinq  devices.  An  examole  of  an  estimated 
variable  would  be  aircraft  around  velocity,  Vg,  a necessary  variable 
In  beam  capture  computations  based  on  aeometry.  The  DFDC  measures 
airspeed  and  course  datum  error  and  in  some  way  estimates  aircraft 
ground  velocity  by  compensatina  for  the  effects  of  wind  velocity. 

The  predicted  variables  are  those  terms  comouted  from  the  estimated 
and  measured  variables  to  where  the  DFDC  "thinks"  the  aircraft  will 
move.  The  Kalman  estimation  process  which  is  the  principal  orocess 
by  which  an  estimate  of  radio  beam  and  beam  rate  are  derived  is 
addressed  in  Paragraph  3 .2.  The  TACAN  control  laws  which  are  desioned 
to  capture  and  track  TACAJl  radio  information  with  provisions  to  minimize 
overstation  problems  are  presented  and  discussed  in  Paragraph  3 . 3. 

The  localized  control  laws  which  are  designed  to  capture  and  track  ILS 
localizer  radio  information  are  presented  and  discussed  in  Para- 
graph 3.4.  The  glideslope  control  laws  which  are  designed  to  capture 
and  track  ILS  glideslope  radio  information  are  presented  and  discussed 
In  Paragraph  3 .5. 


Circular  Capture  Algorithm 

The  DFDC  was  conceived  as  a general  replacement  for  the  CPU-30/A 
flight  director  computer  but  with  improved  control  laws,  particularly 


• Symbols  meaning  variables  like  <J,  which  is  bank  angle. 

^•Paragraph  3.1  presents  the  circular  capture  algorithm,  control 
laws,  and  Kalman  filter  in  terms  of  scripted  variables.  The 
remaining  sections  present  terms  in  the  form  as  they  are  used 
In  the  computer  proorams.  For  instance,  p would  be  implemented 
as  PHI,  0 command  would  be  PHIC,  etc. 
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in  the  capture  computations.  The  capture  computations  can  be 
visualized  as  computing  a circle  v/hich  would  be  tangential  to 
the  aircraft  flight  path  and  to  the  center  line  of  the  radio 
beam  to  be  acquired.  By  utilizing  a predi cti ve-correcti ve 
technique,  it  is  feasible  to  compute  the  aircraft  ground  velocity 
and  the  mean  wind  allowing  for  compensation  of  these  terms  during 
the  capture.  The  key  to  the  computations  is  to  derive  good  estimates 
of  beam  position  and  beam  rate.  These  terms  are  central  to  the 
estimation  of  distance  from  the  station  of  aircraft  around  velocity 
and  of  wind. 

The  key  challenge  in  the  estimation  process  was  the  necessity 
to  obtain  derivative  information  from  noisy  beam  data.  The  deriva- 
tive information  is  required  for  two  reasons:  1)  the  only  available 
data  relating  to  range-to-station  is  contained  in  the  ratio  of  beam 
and  beam  rate  at  the  given  aircraft  ground  velocity,  and  2)  rate 
damping  is  needed  in  the  track  laws.  To  avoid  enhancing  the  hioh 
frequency  noise  present  in  the  signal,  the  derivative-taking  pro- 
cess must  be  restricted  to  lov;  frequencies.  However,  the  derivative- 
taking  process  must  extend  to  high  enough  frequencies  to  adequately 
track  a dynamically  changing  beam.  Typically,  a performance  trade- 
off must  be  considered  betv/een  tracking  error  and  noise  error 
since  minimizing  one  enhances  the  other.  In  the  analysis,  an  ad- 
vantage was  found  to  exist  in  using  a filter  which  contains  a model 
of  the  dynamical  process  such  as  a Kalman  filter.  Hence,  a Kalman 
filter  was  developed  to  perform  the  estimation  process  of  deriving 
beam  and  beam  rate  information.  Once  a Kalman  filter  is  essentially 
tracking  the  process,  it  has  a better  capability  than  a simpler  filter 
to  reject  noise  without  excessive  tracking  error.  However,  these 
filters  must  be  initialized  (i.e.,  the  dynamical  model  must  have  a 
starting  point).  In  the  initialization  process  they  are  also  subject 
to  noise.  If  quick  initialization  is  attempted,  noise  errors  grow; 
while  if  a slow  initialization  is  permitted,  tracking  errors  grow. 
Clearly  for  the  capture  maneuver  initialization  time  is  limited. 
Initialization  cannot  start  until  the  beam  is  intercepted,  a beam  devi- 
ation* greater  than  2.75-3.0°  does  not  yield  usable  radio  information, 
and  it  must  be  complete  before  the  radio  deviation  becomes  too  small. 
The  signal  to  noise  ratio  of  the  radio  deviation  decreases  as  the 
beam  angle  decreases. 

Almost  any  control  analysis  is  confronted  wi th  two  distinct  considera- 
tions, the  physical  control  of  the  plant,  in  this  case  an  aircraft, 
and  the  measurement  or  estimation  of  the  state  parameters  needed  to 
implement  the  control  laws.  Hence  Figure  40  has  sought  to  initially 
separate  the  control  analysis  from  the  estimation  analysis.  In  this 
way  each  nay  be  understood  in  its  own  right  without  the  confusion  of 
cross-coupling  effects.  In  the  following  description  and  sections, 
the  control  and  estimation  processes  are  discussed  separately  but 
the  intertace  between  them  is  completely  described. 

Figure  4n  provides  a conceptual  view  of  the  total  lateral  axis  con- 
trol-estimation process  for  the  DFDC  (the  longitudinal  axis  is  directly 
analogous).  Figure  40  illustrates  in  a block  diagram  form  how  the 


* For  TACAN,  localizer,  and  glideslope,  the  beam  limits  are  approxi- 
mately 10°,  3°,  and  1°,  respectively. 
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Beam  Noise 


Figure  40.  Total  Lateral  Axis  Control -Estimation  Process 
for  the  Digital  Flight  Director  Computer. 


99 


r 


major  elements  of  the  control -estimation  process  are  interrelated  to 
one  another.  First,  the  sensors  provide  information  as  to  the  state 
of  the  di rcraft  relative  to  a radio  beam  that  is  to  be  acquired.  The 
Kalman  filter  uses  the  sensor  information  and  control  law  state 
to  provide  a best  estimate  of  position  and  position  rate  information 
to  the  control  laws.  The  control  laws  use  the  unprocessed  sensor 
information  and  the  processed  Kalman  filter  sensor  information,  posi- 
tion and  rate,  to  1)  provide  control  modes  for  the  ai  rcraft  "such  as 
manual  heading,  capture  and  track,  and  2)  to  provide  control  logic 
to  switch  from  one  mode  to  another.  The  control  laws  compute  a bank 
command  for  the  lateral  axis  to  1)  maintain  a manual  heading  mode  until 
the  control  logic  has  determined  that  the  mode  of  the  DFDC  should  be 
switched  to  capture,  2)  capture  the  desired  radio  beam  by  causing  the 
aircraft  to  fly  a "constant"  bank  such  that  a circular  arc  is  flown 
tangent  to  the  radio  beam,  and  3)  track  the  raoio  beam  once  acquired. 

The  bank  command  at  all  times  is  rate  and  amplitude  limited  to  5.0°/sec- 
ond  and  30.0°,  respectively. 

The  circular  capture  algori thm  whi ch  consists  of  1)  computing  a bank 
command  which  causes  a circular  capture  of  the  radio  beam  to  be  acquired, 
2)  estimating  wind  velocity,  and  3)  estimating  ground  velocity  was 
derived  for  ILS  localizer  mode  as  follows.  From  the  well-known  rela- 
tion for  an  aircraft  in  a coordinated  turn  of  constant  radius,  the 
following  relation  may  be  derived  for  the  instantaneous  radius  of 
curvature  of  the  path  with  respect  to  ground. 


g tan 


6.1) 


This  equation  forms  the  starting  point  for  the  circular  capture  algorithm. 
We  wish  to  fit  a constant  radius  turn  between  the  present  flight  path 
and  the  desired  radio  beam  to  be  acquired.  From  the  kinematics  of  the 
situation,  r can  be  calculated  and  the  required  bank  command  computed 
from  equation  3.1.  The  first  problem  to  address  is  that  of  determining 
r.  Figure  41  illustrates  the  derivation  of  the  r and  its  geometric 


(3.2) 


interpretation.  Once  having  the  value  of  r,  the  circular  bank  command 
can  be  written  as  follows: 


♦ = tan 


(3.3) 


If  the  quantities  in  these  equations  were  available  error  free,  they 
could  be  applied  directly.  However,  several  problems  exist.  Ground 
speed,  is  not  readily  available,  although  airspeed  (Uq)|^  is.  There 
will  be  errors  in  measuring  ij/,  course  datum  error.  Range,  r,  is  not 
readily  available  in  any  direct  measurement  except  for  a ratio  of  beam 
and  beam  rate.  Finally,  in  taking  the  derivative  of  beam  deviation 
9 to  get  6,  errors  will  result  since  0 is  typically  noisy.  Another 
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factor  1s  that  turbulance,  steady  winds  and  wind  shear  would  cause 
an  open  loop  control  calculation  at  a single  point  to  perform  poorly. 
To  overcome  the  latter  problem,  a multistage  decision  process  was 
employed  where  new  data  is  taken  and  a new  command  computed  every 
0 seconds.  The  multistage  decision  process  is  illustrated  in  Figure 
42  . (Figure  43  illustrates  the  computation  and  geometric  inter- 

pretatlon  of  W,£,<ik.)  The  result  of  the  first  step  of  the  process 

Is  the  computation  of  the  apparent  position  error  vector .c^.  Step 

two  uses  the  apparent  position  error  vector  to  generate  an  estimate 
of  the  wind  vector,  W<.  The  vector  equation  for  Is: 

k ' ^ (3.4) 


Where  Is  the  apparent  position  error  vector,  J is  the  sample  time, 

and  X Is  a proportionality  constant  whose  optimum  value  was  deter- 
mined from  hybrid  simulation.  Thus,  the  best  estimate  of  ground 
velocity  becomes: 


<Vk  ‘ * “k  ' 

Finally,  step  three  results  in  the  computation  of  the  bank  command  which 
results  in  the  optimal  circular  capture.  Figure  4a  illustrates 
the  flow  chart  and  equations  for  the  originally  proposed  ILS  localizer 
mode  circular  capture  algorithm.  These  equations  and  flow  chart 
Illustrate  the  measurement,  prediction,  and  estimation  process  required 
to  derive  the  best  estimate  of  wind,  ground  velocity,  and  the  computa- 
tion of  the  circular  bank  command,  : , 

Figure  45  illustrates  the  current  circular  capture  algorithm  for  the 
ILS  localizer  mode.  The  flow  chart  and  equations  define  the  computational 
process  for  estimating  wind,  ground  velocity,  and  flight  path  angle 
resulting  in  the  circular  capture  bank  command,  . The  differences  in 
Figures  44  and  45  are  discussed  in  the  follaving. 

The  computation  of  range-to-station , equations  3.8-1,*  and  3.8-3,  was 
modified  to  equation  3.9-2.  The  implementation  of  equation  3.9-2  re- 
sults in  a measurement  of  range-to-station,  R.;,  by  usino  the  best 
estimates  of  ground  velocity,  flight  path  angle,  beam,  and  beam  rate. 

The  measured  range  is  then  smoothed  through  a predictive-corrective 
type  filter. 

The  computational  method  of  equation  3.8-2  was  modified  by  substituting 
equation  3.1  resulting  in  equation  3.9-1.  This  equation  provides 
feedback  in  the  form  of  the  measured  bank  of  the  aircraft  as  to  the 


* The  notation  3.8-1  refers  to  Figure  44.,  equation  1. 
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Figure  44.  Originally  Proposed  ILS  (Localizer)  Mode 
Circular  Capture  Algorithm. 


actual  circular  arc  that  is  being  flown.  This  feedback  provides 
correcting  information  during  that  time  when  the  pilot  desires 
not  to  imolement  the  bank  steering  command. 

The  wind  computation  consists  of  equation  3.8-4  through  3.8-8  and 
has  been  converted  from  a magnitude,  angular  computation  to  equations 
3.9-4  through  3.9-7,  consisting  of  cross  track,  and  of  along  track 
wind  computations.  The  reason  for  the  modification  was  a result 
of  1)  computing  the  difference  of  too  "large"  numbers  in  equation 
3.8-5,  and  2)  requiring  the  implementation  of  the  inverse  cosine 
function. 

The  control-estimation  equations  for  the  longitudinal  axis  were 
developed  in  a very  similar  manner  to  those  of  the  lateral  axis. 
Referring  to  Figure  39  and  notina  the  follavinq  similarities: 

•S'  li-;  C ' 6;  S ' R,  Vj  ' Vg,  r ' n,  the  equations  for  the  longitudin- 
al case  can  immediately  be  written  except  for  the  command  equation. 
Recalling  that  the  constant  bank  command  implies  constant  heading 
rate,  the  form  of  the  command  is  indicated  by 

V 

fi.-L-  (3.6) 

n 

where  is  the  pitch  angle.  That  is,  one  should  command  constant 
pitch  rate  to  fly  a circular  segment  in  the  vertical  plane.  The 
resulting  command  equations  are: 


1 - COS6 


si  = '^T/r 

Figure  4^'  illustrates  the  originally  proposed  ILS  qlideslope 
circular  capture  algorithm.  The  modification  to  the  glideslope 
algorithm  follows  directly  from  the  localizer  discussion  of  Para- 
graph 3.1.  The  current  ILS  glideslope  circular  capture  algorithm 
is  illustrated  in  Figure  47  . 

Kalman  Estimation  Process 

A block  diagram  of  the  discrete  time  Kalman  estimator  is  illustrated 
in  Figure  4H  . Notice,  the  predictive-corrective  nature  of  the 
estimator,  the  dynamical  model  produces  a predicted  next  state  x;: 
which  is  multiplied  by  the  H|^  matrix  to  form  a predicted  measurement 
Z^.  The  difference  between  the  predicted  and  the  actual  measurements, 
"the  apparent  state  error  vector",  is  operated  on  by  the  Kalman 
gains,  K|^,  and  is  used  to  "correct"  so  as  to  form  x,..  the  best 

estimate  state  vector. 

The  detailed  matrix  difference  equations  for  the  dynamical  model  in 
the  Kalman  estimator  are  illustrated  in  Figure  49  . Notice,  the 
definition  of  the  state  vector,  x-  X]  is(Re),  cross  track  distance. 
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Figure  49.  Position,  Position  Rate  (y,y) 
Kalman  Estimator. 
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X2  is  (R'G),  cross  track  rate.  The  radio  beam  noise  is  modeled  by 
X3  which  has  a four  second  correlation  characteristic.  Gust 
activity  moves  the  aircraft  in  a noise-life  manner.  The  resultinq 
aircraft  acceleration  is  modeled  by  X4  which  is  a two  second 
correlated  noise  sequence. 

A feature  that  is  included  in  the  measurement  model  is  a measurement 
noise  (assumed  white)  with  covariance  matrix  R|^.  R|^  is  a 1 x 1 

matrix  or  scalar.  Intuitively,  the  measurement  noise  matrix  pro- 
vides the  filter  with  some  information  relative  to  the  signal  to 
noise  ratio  of  the  incoming  data.  This  is  clearer  if  one  reviews  the 
way  the  Kalman  gains  are  generated.  The  optimal  state  estimate  at 
time  will  be  given  by  the  state  estimation  equations  as 


^ = (1ik.k-1)^-1  + ^<-1 


(3.8) 


Where  (referring  to  Figure  49  ) 
f<-l  is  the  forcing  term  in  the 


is  the  transistion  matrix, 
dynamical  model  (discussed 
above)  and  K^  is  the  Kalman  gain  matrix.  Notice  that  when  elements 
of  K^  are  large,  much  confidence  is  being  placed  in  the  measured 
data  and  conversely  when  they  are  small,  less  weight  is  being  given 
to  the  received  data.  To  see  that  the  measurement  noise  covariance 
matrix  accomplishes  this  desired  end,  examine  the  recursion  relations 
that  generate  the  Kalman  gain  matrix,  equation  3,9a. 


" ‘^IC,K-1  ^K-l'^K.K-l  +Q|C-1 

K<  = P'A 


(3.9a) 


- W'< 


.T 


P|<Pj 


Qk 


(3.9b) 


= P, 


= 0 for  al 1 k 
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Since  occurs  in  a matrix  summation  and  that  summation  is  subsequent- 
ly inverted  and  used  as  one  of  the  terms  of  a matrix  product  to  gener- 
ate the  gain  matrix  Kk,  then  making  the  elements  of  large  will 
tend  to  decrease  the  gain  and  the  converse  is  also  true.  It  has  been 
found  that  making  some  elements  of  the  Q<  matrix  large  will  tend  to 
keep  the  Kalman  gains  initially  high,  aiding  in  the  initial  convergence 
and  tracking  during  the  capture  maneuver.  As  track  mode  approaches, 
increasing  R,<,  decreases  the  gains  reflecting  1)  the  lower  signal  to 
noise  ratio  in  track  and  2)  the  lower  dynamic  bandwidth  required  in 
track.  These  factors  are  not  contradictory,  they  allow  lower  gains 
in  track,  permitting  the  bank  activity  to  be  held  to  a minimum. 

Equation  3,9b  provides  the  initial  conditions  to  the  recursive  equation 
4.9a.  The  Kalman  fi lter_soluti on  is  the  one  that  minimizes 

E (^K  " 


The  white  noise  sequences  that  occur  in  the  dynamical  model  for  the 
Kalman  estimator  are  illustrated  in  Figure  49  . Basically,  it  is 
the  specified  noise  covariances,  dynamical  and  measurement  models 
that  determine  the  behavior  of  the  filter,  that  is  how  the  Kalman  gains 
are  caused  to  vary.  The  model  was  determined  by  physical  reasoning 
and  the  covariances  were  determined  from  the  noise  models.  In  this 
model,  the  variances  of  the  discrete  white  noise  sequences  were  set 
to  produce  the  oroper  variance  of  the  colored  noise  sequences.  In 

the  case  of  X3,  this  implies  that  E | | = Q33  must  be  set  so  that 

^ equal  to  the  variance  of  the  beam  noise  assuming  a 

zero  mean  process.  The  general  relationship 


(l-e 


(3.10) 


was  used  to  determine  the  covariance  matrix  where  o,  is  the  variance 
of  the  continuous  correlated  noise.  T is  the  sample  time  of  the 
discrete  model,  and  t is  the  correlation  time  of  the  noise.  . 


3.2.1  TACAN  Kalman  Estimation  Process 

The  Kalman  estimator  for  TACAN  retains  the  originally  proposed 
position,  position  rate  form  ( Re,  R‘9)  as  shown  in  Figure  49  , since 
DME  range  information  is  available  to  supply  range  data.  The 
specific  and  matrioos  have  been  tailored  to  this  particular  form. 
The  state  variables  are  as  defined  in  Figure  49  . 

3.2.2  ILS  Kalman  Estimation  Process 

I)  The  basic  Kalman  estimation  al  gori  thm  was  modified  from  a cross  track 

' distance,  cross  track  rate  form,  ( Re,  R9  ) as  described  in  Phase  I 

final  report  to  an  angular  position,  angular  rate  form  ( e,e  ) for 
ILS  modes.  Figure  50  illustrates  the  total  ILS  lateral  axis  con- 
trol-estimation process.  Several  factors  have  influenced  the  change 
from  the  ( Ro,  R9  ) form  to  the  ( e,e  ) form.  The  original  Kalman 
estimator  would  have  been  a natural  choice  if  ILS  range  data  would  have 
been  avai lable.  Since  ILS  range  data  was  not  available,  a pre-filter 
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Block  Diagram  of  the  Total  ILS 
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v;as  required  to  derive  range  to  station  information  and  to  provide 
ini tial i zation  of  the  Kalman  estimator.  Analysis  and  simula- 
tion results  revealed  that  the.  u-i  tracker  pre-filter  did  not 
provide  adequate  simultaneous  suppression  of  beam  noise  and  track- 
ing error  during  the  dynamics  of  the  capture  maneuver.  Close 
tracking  of  beam  rate  was  found  to  be  essential  if  wind  and  range 
errors  were  to  be  separated  during  the  capture  maneuver.  Other  pre- 
filters were  also  extensively  studied  and  it  was  concluded  that  the 
algorithm  of  Figure  50  which  does  not  require  a pre-filter, 
performs  satisfactorily  and  was  thus  selected.  This  algorithm 
has  oroven  that  it  maintains  comparable  performance  to  that  of  the 
originally  proposed  Kalman  estimator  in  the  ILS  modes.  The  state 
variables  for  thelLS  modes  are  defined  in  Figure  51  . Xi  ise,  beam 
position.  X2  is  0,  beam  rate.  X3  is  the  beam  noise.  X4  is  the  gust 
acti vi ty. 

3. 2. 2.1  Localizer  Kalman  Estimation  Process 

Figure  si  illustrates  the  angular,  angular  rate  form  of  the  ILS 
mode  (localizer)  Kalman  estimator.  The  primary  difference  between 
this  form  and  the  position,  position  rate  estimator  used  for  TACAN 
is  the  form  of  the  forcing  term  in  the  X2(k.)  equation.  To  see 
how  this  arises,  let 


y = 9 tan(c>)  cos(r)  (3-1 1) 

where  y is  the  acceleration  of  the  aircraft  relative  to  the  localizer 
beam,  ^ and  ai.'e  bank  and  track  angle  respectively.  If  the  approxi- 
mation 


y = R'5 


(3-12) 


is  used  where  0 is  angular  acceleration  relative  to  the  beam,  then 


6=9  tan('j)  cos(f)/R  (3.13) 

tnis  equatic’n  may  be  discretized  as 

o(<)  = e(<-l)  + J g tan(<t)  cos(r)/R  (3.14) 

equating  X;(-.)  = o{<)  and  adding  the  gust  noise  contribution  yields 
the  formu’ation  illustrated  in  Mqure  51  . The  validity  of  the 

above  approximations  has  been  demonstrated  in  hybrid  simulation 
results,  which  will  be  discussed  in  later  sections  of  this  report. 
In  addition,  elimination  of  the  pre-filter  permits  a simpler  and 
more  direct  synthesis  of  the  Kalman  estimator.  The  discussion  of 
paragrap;h  3.2  relative  to  the  use  of  Q,  and  R matrices  to  tailor 
the  Ka'  ,ian  gains  also  applies. 

3. 2. 2. 2 fjlides'iope  Kalman  Estimation  Process 

The  f:,rrr  of  the  glides  lope  Kalman  estimator  is  identical  to  the 
local'zer  form  shown  in  Figure  51  , except  for  the  forcing  term  in 
the  > (..)  equation.  The  forcing  term  for  the  longitudinal  axis  was 
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= Angular  Beam  Deviation 

Xg  = Angular  Rate 

X„  = Beam  Noise 

X . = Gust  Noise 
4 


Measur ement  Model 


derived  as  follows.  It  can  be  shown  that  the  aircraft  acceleration 
normal  to  the  glideslope  is  approximately 


y = Vn 


(3.15) 


where  V is  the  aircraft  velocity  and  2 is  the  pitch  rate  of  the  air- 
craft, further, 


RC  = y 


(3.16) 


where  R is  the  range  from  the  station  and  cis  the  angular  accelera- 
tion with  respect  to  the  station. 

Substituting  the  forcing  term,  equation  3.16  becomes 

i = Vn/R.  (3.17) 

Discretizing  this  equation  yields 


^.1  ^ J V (3.18) 

Making  the  identification  X2(<)  = completes  the  derivation  of  the 
glideslope  Kalman  estimator.  The  discussion  of  paraaraph  3.2. 
relative  to  the  use  of  the  Qk  and  R<  matrices  to  tailor  the  Kalman 
gains  also  applies. 


s 
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Manual  Heading  Control  Law 


This  mode  is  used  to  acquire  and  maintain  a selected  heading.  Manual 
Heading  mode  is  engaged  by  switching  the  Airspeed  Controller  mode 
switch  to  the  MAN  HDG  position.  The  computational  algorithm 
generates  a steering  needle  command  derived  from  heading  error  and 
bank  angle.  Bank  angle  command  (PHIC)  is  gain  programmed  with  true 
airspeed  according  to  equation  3.19. 

GflH  = 2.0  + limit  (1.0  (b'0-350.0)/l 50.0) 

PHIC  = GHH  + limit  (30.00,  HEADING  ERROR) 

Figure*  117  illustrates  the  Manual  Heading. 

3.4  TACAN  Control  Laws 

The  TACAN  control  laws  are  designed  to  capture  and  track  TACAN  radio 
information  with  provisions  made  to  minimize  overstation  cone  of 
confusion  problems.  Provisions  are  provided  for  automatic  switching 
to  a new  outbound  radial  as  the  station  is  overflown.  The  sub-modes 
of  TACAN  are: 

1)  Heading  Hold 

2)  Capture 

3)  Track 

4)  Overstation 

The  heading  hold  mode  is  included  in  the  TACAN  control  laws  to  main- 
tain a preset  compass  course.  This  preset  compass  course  is  flown 
until  the  aircraft  has  moved  such  that  the  capture  conditions  are 
satisfied.  Once  the  capture  conditions  are  satisfied,  the  mode  of 
the  DFDC  is  switched  to  capture.  The  gain  on  heading  error  is  a 
programmed  function  of  airspeed. 

The  capture  mode  is  used  to  control  the  aircraft  during  the  capture 
phase  of  TACAN  mode  until  conditions  for  switching  to  track  mode 
are  satisifed.  During  the  capture  mode,  the  bank  command  will  cause 
the  aircraft  to  follow  a piece-wise  circular  path. 
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The  track  mode  is  used  to  control  the  aircraft  after  the  TACAN  beam 
has  been  attained.  The  track  mode  generates  a bank  command  which 
when  implemented  by  the  pilot  will  cause  the  aircraft  to  closely 
track  zero  beam  deviation. 


The  overstation  mode  is  a manual  heading  type  mode  which  causes 
the  aircraft  to  fly  course  datum  error  to  zero. 

A typical  sequence  of  operation  proceeds  as  follows.  On  engagement 
of  TACAN  mode  the  DFDC  remains  in  heading  hold  until  the  caputre 
conditions  are  satisfied.  Capture  is  then  engaged  and  flown  until 
the  track  conditions  are  satisfied.  The  mode  is  switched  from 
capture  to  track  and  a smooth  transition  to  track  occurs,  resulting 
in  the  aircraft  following  the  selected  radial.  At  a pre-programmed 
distance  ( lO.Onm  at  500.0  knots)  from  the  station,  the  DFDC 
switches  to  overstation  mode.  Overstation  mode  commands  the  aircraft 
to  fly  the  course  selected.  At  this  point  the  pilot  may  select  a new 
outbound  radial  by  dialing  up  a new  course  selection.  The  system 
will  then  command  the  aircraft  to  the  new  course  based  on  course  datum 
error.  On  exit  from  the  overstation  mode,  the  aircraft  will  most 
probably  be  parallel  to  the  selected  radial,  but  offset  from  it.  The 
diaital  flight  director  switches  to  capture  mode  until  the  new  radial 
is  acquired  and  then  tracks  it. 


Flow  diagrams  presented  in  Figures  112  through  118  in  Appendix  A 
Illustrate  the  complete  documentation  for  TACAN  mode. 

Heading  Hold  Mode 

The  heading  hold  mode  will  be  maintained  once  TACAN  mode  is  selected 
on  the  air  speed  controller  until  the  capture  conditions  are  satisfied. 
Notice  that  the  DFDC  will  switch  directly  into  capture  mode  if  TACAN 
is  selected  after  the  capture  trip  point  has  been  satisfied.  Basic- 
ally the  heading  hold  mode  bank  command  (equation  3.19  and  Figure  117 
) will  maintain  the  aircraft  on  the  heading 


GHH  = 2.0  + LIMIT  ( 1.0,  (UO  - 350.0  )/150.0) 
PHIC  = GHH*LIMIT  (30.0°,  HEADING  ERROR). 


(3.19) 


selected  as  a function  of  heading  error.  The  gain  of  heading  error 
Is  a pre-programmed  function  of  airspeed. 


Capture  mode  engagement  occurs  when  the  aircraft  reaches  a computed 
capture  trio  point.  There  are  two  conditions  that  will  cause  capture 
to  occur.  These  two  conditions  are  1)  the  LBS  override  is  set  or 
2)  the  normal  capture  trip  point  is  satisfied.  During  normal  operation, 
lBS  not  set,  there  are  three  conditions  that  must  be  satisfied  before 
the  mode  of  operation  is  switched  from  heading  hold  to  capture.  These 
conditions  are  illustrated  in  equation  3.20  and  Kif-uro  112. 
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1)  ABS(  RH*QH  ) ,LT.  lO.ONM. 

2)  The  Kalman  Filter  must  have  been  running  for  3.0  sec. 

3)  a)  PHICL  and  PHICT  must  be  of  the  same  sign.  (3.20) 

b)  PHICT  .GT  ADJPHL*PHICL 

where  ADJPHL  = 0.35  + LIMIT  (0.15,  0. 3*(RH-70.0)/80.0) 
OR 

a)  ABS  (QH)  .LT.  IS^iA  .AND.  PHICT  .LT.  1° 

3.4.2  Capture  Mode 

The  capture  mode  has  been  designed  such  that  it  will  cause  the  air- 
craft to  fly  a piece-wise  circular  path  to  intercept  the  selected 
TACAN  radial.  (For  very  small  initial  course  errors  an  exponential 
type  capture  will  result.)  The  computational  alqorithm  is  illus- 
trated in  equation  3.21  and  Fieures  113  and  n? 


I 


GP  = 1.0 

IF  (RH  .GT.  SO.ONM)  GP  = 50.0/RH 
CF  = EXP(  -JO/30) 

X2L  = CF*(  X2l  - QDB  ) + QDB 
XSIL  = CF*(  XSIL  - GAMH  ) + GAMH 

YDT  = X2L  = VHG*(  GAMH  - XSIL  ) (3. 21) 

PHICT  = GP*(  KY*QH*RH  + KY*YDT  ) 
where  KY  - 5.0O/NM 

KY  = 0.120/KNOT 

PHICL  = ATAN  ( VHG**2*(1  .0-C0S(GAMH)J/{G*RH*0H)  ) 

PHIC  = MIN  ( PHICL,  PHICT  ) 

In  addition,  the  capture  mode  insures  that  the  system  will  properly 
handle  a situation  where  a capture  is  initialized  in  a near  parallel 
or  fly  away  condition  relative  to  the  selected  radial.  Such  a condi- 
tion may  well  occur  on  exit  from  overstation  mode.  The  track  logic 
has  been  designed  such  that  the  circular  command  will  be  maintained 
until  the  beam  deviation  is  sufficiently  small  and  a smooth  transi- 
tion from  capture  to  track  will  occur.  Figurps  n h anH  114  illus- 
trates the  control  logic  for  transition  from  capture  to  track. 

3.4.3  Track  Mode 

In  the  track  mode  the  aircraft  is  commanded  to  hold  the  selected 

radial  with  a bank  command  (equation  3.21,  PHICT)  that  is  a linear  j 

' function  of  cross  track  deviation  (CTD)  and  cross  track  deviation  3 

I rate  (CTR).  The  noise  level  on  the  TACAN  beam  data  is  greater  than 

1 that  on  the  localizer  beam  so  that  much  more  care  is  necessary  in 

1 deriving  CTR  if  bank  activity  is  to  be  held  to  a minimum.  A com- 

1 plementation  of  the  Kalman  filter  rate  and  aircraft  track  angle  has  been 

formed  to  produce  a cleaner  rate  signal  in  this  mode.  The  track  gains 
are  set  such  that  adequate  tracking  is  maintained,  but  such  that  the 
bank  activity  is  not  excessive.  As  discussed  earlier  when  the  range 

from  the  station  is  less  than  a programmed  trip  point,  the  mode  is  ' 


li 

li 


J 
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switched  from  track  to  overstati on.  Figure  115  illustrates 

the  control  logic  for  transition  from  track  to  overstation. 

3.4  4 Overstation  “'ode 

The  overstation  mode  is  used  to  command  the  aircraft  while  the 
aircraft  is  in  the  station  cone  of  confusion.  The  bank  command 
(equation  3.22  and  Flcuro  117  ) is  a product  of  a gain  term 

GHH  = 2.0  + LIMITd.O.  (UO  - 350.0)/150.0) 

(3-22) 

PHIC  = GHH*LIMIT{30.0°,  COURSE  ERROR) 

which  is  a function  of  airspeed  and  course  datum  error.  This  per- 
mits the  pilot  to  turn  the  aircraft  parallel  to  a new  outbound  radial 
by  turning  the  course  selection  knob  when  he  is  in  overstation.  Once 
the  station  has  been  overflown  and  range  again  reaches  the  overstation 
trip  point,  the  mode  is  switched  from  overstation  to  capture,  initiali- 
zing the  acquisition  of  the  new  radial.  Fipure  116  illustrates  the 
control  logic  for  overstation  to  capture  switching. 


3.4  5 Range  Estimation 

Range  estimation  is  not  necessary  in  TACAN  mode  since  DME  range 
information  is  available.  However,  a DME  range  smoothing  algorithm 
is  required  and  is  illustrated  in  Figure  119 

5.4  .6  Wind  Estimation 

The  lateral  axis  wind  computational  algorithm  for  the  DFDC  consists 
of  separating  the  wind  computation  into  an  along  track  component  and 
a cross  track  component,  equation  3.23.  The 

GAME  = GAMH  + T G SIN(PHI)/(VHG  COS(PHI)  ) 

ATE  = RH  - RHO  + T VHG  COS (GAME) 

CTE  = RH  QH  - RHO  QHO  + T VHG  SIN (GAME) 

ATW  = ATW  + LA  ATE/T 
CTW  = CTW  + LC  CTW/T 

HH  = ATW'2  + CTiF  (3.23) 

OH  = ATAN(  CTW /ATW  ) 

CWH  = WH  C0S(  OH  - PS  I ) 

SWH  = WH  siru  OH  - PSI  ) 

VHG  = TTU0‘ + CWH)-’ 

GAMH  - PSI  + ATAN  (SWH/(U0  + CWH)  ) 

; computational  algorithm  usino  along  track  and  cross  track  wind,  to 

compute  wind,  functioned  properly  and  is  illustrated  in  Figure  47 

X However,  from  simulation  results  that  illustrated  that  the  along 

track  wind  component  was  not  required,  the  along  track  wind  component 
l was  dropped,  resulting  in  the  present  form  of  the  computational 

I algori thm  whi ch  is  illustrated  in  equation  3,24. 
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GAr-lE  = GAM.M  + T G SIN(PHI  )/(VHG  CCS(PHI) 
CT£  = RH  QhO  - RH  QH  - T VHG  SIN(GAME) 

CTW  = CTW  + LC  LIMIT  ( 0.0012,  CTW  )/T 

WH  = ABS(CTW)  - 
OH  - SIGN(  90.0  , CTW  ) 

CWH  = WH  COS(  OH  - PSI  ) 

SWri  = WH  SIN(  OH  - PSI  ) 


GAMH  = PSI  + ATAN(  SWH/(UO  + CWH)  ) 


ILS  Localizer  Control  Laws 


(3.24) 


The  localizer  control  laws  are  dcsianed  to  capture  and  track  ILS 
localizer  radio  information.  The  sub-modes  of  ILS  localizer  are: 


1 ) Heading  Hold 

2)  Capture 

3)  Track 


The  heading  hold  mode  is  included  in  the  localizer  control  laws 
to  maintain  a preset  compass  course.  This  preset  compass  course  is 
flown  until  the  aircraft  has  moved  such  that  the  capture  conditions 
are  satisfied.  Once  the  capture  conditions  are  satisfied,  the  mode 
of  the  DFDC  is  changed  to  localizer  capture.  The  gain  on  heading 
error  is  a programmed  function  of  airspeed. 


The  capture  mode  controls  the  aircraft  during  the  capture  phase  of 
localizer  mode  until  conditions  for  switching  to  track  mode  are 
satisfied.  During  the  capture  mode,  the  bank  command  will  cause  the 
aircraft  to  follow  a piece-wise  circular  path. 

The  track  mode  controls  the  airTaft  after  the  localizer  beam  has 
been  acquired.  The  transition  i rom  capture  mode  to  track  mode 
consists  of  fading  the  bank  command  from  one  control  to  the  other. 

Tne  track  mode  generates  a bank  command  which  when  implemented  by  the 
pilot  will  cause  the  aircraft,  to  closely  track  zero  beam  deviation. 

A typical  sequence  of  operation  proceeds  as  follows.  On  the  selec- 
tion of  ILS  mode  on  the  air  speed  controller,  the  DFDC  would  remain 
in  neading  hold  mode  until  the  capture  conditions  are  satisfied. 

Once  the  capture  conditions  are  satisfied,  the  capture  mode  would 
be  engaged  and  flown  until  the  track  conditions  are  satisfied. 

Having  satisfied  the  tracK  conditions,  the  track  mode  will  be 
engaged  and  a smooth  transition  in  bank  command  v;ill  occur.  Once 
having  engaged  the  track  mode,  the  DFDC  will  remain  in  the  track 
mode  until  a new  mode  is  selected  on  the  air  speed  controller. 

Flow  diagrams  presented  in  Figuresns,  120,  121,  and  122  in 
Appendix  A illustrate  the  complete  documentation  of  ILS  localizer 
mode. 


3.5,1  Heading  Hold  Mode 

The  heaaing  hold  mode  provides  a bank  command  (equation  3.25  and 
FI  pure  118)  whicj^.  when  implemented  will 


122 


9 


f 

I 


GMH  = 2.0  + LIM1T(1.0,  (UO  - 350.0)/150.0) 
PHIC  = GHH*LIMIT(30.0°,  HEADING  ERROR) 


(3.25) 


Maintain  the  aircraft  on  a preset  compass  heading.  The  gain  on 
headina  error  is  programmed  function  of  airspeed. 

The  heading  hold  mode  v/ill  be  maintained  once  ILS  mode  is  selected 
on  the  air  speed  controller  until  capture  conditions  are  satisfied. 
Capture  mode  engagement  occurs  when  the  aircraft  reaches  a computed 
capture  trip  point.  There  are  two  conditions  that  will  cause  the 
mode  to  be  switched  to  the  capture  mode.  These  two  conditions  are 
either  1)  the  LBS  override  is  set  or  2)  the  normal  capture  trip 
point  is  satisfied.  These  conditions  are  illustrated  in  Figure  120 
. During  normal  operation,  lBS  is  not  set,  there  are  three 
conditions  that  must  be  satisfied  before  the  mode  of  operation  can 
be  switched  from  heading  hold  to  capture  mode.  These  conditions 
are  as  follows: 

1)  The  estimated  radio  deviation  must  be  less  than  240uA  for 
3.0  sec.  (This  will  prevent  false  captures.) 

2)  The  calculated  capture  bank  command  must  be  greater  than 
(2.0°  + ABS(estimated  radio  deviation)'^  ). 

3)  RANGE  .GT.  10.0  NM:  The  estimated  radio  deviation  must  be 

Less  than  180  uA. 

RANGE  .LT.  10.0  NM:  The  estimated  radio  deviation  must  be 

less  than  iBOuA  + 6.0  (10.0  - RH)uA). 


When  the  aircraft  reaches  the  computed  capture  trip  point,  the  DFDC 
control  law  mode  is  switched  from  heading  hold  mode  to  capture  mode. 
The  mode  of  the  digital  flight  director  will  also  be  switched  from 
heading  hold  mode  to  the  capture  mode  if: 

1)  The  estimated  beam  deviation  has  been  less  than  240uA  for 
3.0  sec. 

2)  The  estimated  beam  magnitude  is  less  than  30uA. 


3.5.2  Capture  Mode 

The  capture  mode  controls  tiie  aircraft  from  the  calculated  capture 
trip  point  until  the  aircraft  has  moved  within  the  track  trip  point. 
The  computational  algorithm  (equation  3.26  and  vipnr..  iik  and 
122  ) for 

PHICL  = ATAN(  VHG**2*(1.0  - COS (GAMH ) )/ (G*RH*QH ) ) 

(3.26) 

the  capture  mode  bank  command  will  cause  the  aircraft  to  follow  a 
piece-wise  circular  path  until  track  mode  is  engaged.  Ficure  121 
illustrates  the  four  conditions  that  will  cause  the  track 
mode  to  be  engaged.  These  conditions  are  as  follows: 
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3.5.3 


3.5.4 
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1)  The  estinated  radio  deviation  is  less  than  30.0  uA. 

2)  The  estimated  radio  deviation  is  less  than  ABS  (45.0  uA) 
and  the  estimated  pam.ma  is  less  than  20. 0“. 

3)  The  estimated  radio  deviation  is  less  than  -45.0  uA 
and  the  estimated  gamma  is  greater  than  20.0°. 

4)  The  estimated  radio  deviation  is  greater  than  45.0  uA  and 
the  estimated  gamma  is  less  than  -20.0°. 


When  one  of  the  above  conditions  is  satisfied,  the  DFDC  mode  is 
switched  from  capture  to  track. 


Track  Mode 

The  track  mode  is  the  final  mode  of  the  localizer  algorithm  and 
provides  a bank  command  that  is  a linear  function  of  y and  y. 

The  track  mode  provides  a smooth  transition  from  the  caoture  mode  to 
the  track  mode.  At  the  instant  of  transfer  from  the  capture  mode, 
a fader  command  value  is  retained.  The  retained  fader  command  value 
is  the  bank  command  difference  between  the  capture  mode  and  the  track 
mode  laws.  During  the  initial  part  of  the  track  mode  the  fader 
command  is  geometrically  decreased  to  zero. 

When  the  computed  track  bank  command  (equation  3.27  and  Ficure  i?2 


GP  = 8.0/(7.0  + 573.(?*ABS(  QH  ) ) 

PHICT  = GP*KY*QH  + KY*QDB 

IF  (RH  .LT.  5.0.NM)  PHICT  = RH*PHICT/5.0  (3.27) 

WHERE  KY  = 4.0V70.0  FT 

Ki  = 35.0V70.0  FT/SEC. 

is  implemented,  the  aircraft  closely  tracks  zero  estimated  beam 
devi ati on. 


Range  Estimation 

The  computational  algorithm  for  the  localizer  range  estimate  is 
illustrated  in  equation  3.28  and  Fienrp  122  • A range  measure- 

ment is  computed  using  the 

RA  = VGH*SIM(QH  - GAMH)/QDB 
RE  = RH  - T*VHG*COS(GAMH) 

IF  ( ( ABS(QH)  .LT.  75UA)  .AND. 

(LATSW  .NE.  MANUAL  HEADING)  ) AY  = 0.95*AY  (3.28) 

RH  = RE  + AY*LIMIT  (20.0*J0,  RA-RE) 

IF  (RH  .LT.  5.0NM)  RH  = 5.0NM 

IF  (GSCORT)  RH  = RE  + 0.1*(SH  - RE  + 1.5NM) 

Kalman  derived  radio  rate.  The  range  is  then  smoothed  through  a 
predictor-correlator  type  filter. 

Once  glides  lope  has  engaged,  RH  is  up-dated  as  a function  of  radar 
dl  ti tude . 
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3.5.5 


Wind  Estimation 


The  discussion  of  the  lateral  wind  computation  was  covered  in 
paragraph  3.46. 

3.6  ILS  Glideslope  Control  Laws 

The  ILS  glideslope  control  laws  are  designed  to  capture  and  track  ILS 
glideslope  radio  information.  The  sub-modes  of  ILS  glideslope  are: 

1)  Idle 

2)  Precapture 

3)  Capture 

4)  Track 

The  idle  mode  is  a do-nothing  mode.  That  is,  no  computations  are  per- 
formed except  to  check  if  the  Kalman  filter  should  be  started.  Once 
the  conditions  to  start  the  Kalm.an  filter  are  satisfied,  the  DFDC  mode 
is  switched  from  idle  to  precapture.  However,  in  the  simulation 
results,  a pitch  com.mand  is  computed  to  maintain  a preset  altitude. 

The  precapture  mode  performs  all  computations  that  are  in  the  glideslope 
algorithm.  In  addition,  it  computes  the  glideslope  capture  trip 
point.  Once  the  capture  trip  point  has  been  satisfied,  the  DFDC  is 
switched  from  precapture  to  capture  mode. 

The  capture  mode  controls  the  aircraft  during  the  capture  phase. 

The  computed  pitch  command  will  cause  the  aircraft  to  follow  a 
piece-wise  circular  path.  The  capture  mode  is  maintained  until 
conditions  are  satisfied  for  glideslope  track  engage,  at  which  time 
the  mode  is  switched  from  capture  to  track. 

The  track  mode  is  the  final  glideslope  mode  and  calculates  a pitch 
command  which  when  implemented  will  cause  the  aircraft  to  closely 
track  zero  beam  deviation. 

During  the  idle  and  pre-capture  modes,  the  horizontal  steering  pointer, 
HPTR,  is  biased  out  of  view.  HPTR  is  brought  in  view  only  at  glide- 
slope  capture. 

A typical  sequence  of  operation  proceeds  as  follows.  On  selection  of 
the  ILS  mode  on  the  air  speed  controller,  the  DFDC  would  remain  in 
the  idle  mode  until  localizer  no  longer  was  in  heading  hold  mode  and 
the  olideslope  beam  deviation  was  less  than  120. OUA.  Once  these  two 
conditions  are  satisfied,  the  mode  would  be  switched  to  pre-capture  mode 
and  the  Kalman  filter  would  be  initialized.  The  pre-capture  mode 
would  be  maintained  until  the  capture  conditions  are  satisfied,  at 
which  time  the  mode  vjould  be  switched  from  pre-capture  to  capture. 
Capture  v/ould  be  flown  until  the  track  conditions  are  satisfied. 

Having  satisfied  the  track  conditions,  the  track  mode  would  be  engaged 
and  a smooth'  transition  in  pitch  command  would  occur.  Once  having 
engaqed  the  track  mode,  the  DFDC  will  remain  in  the  track  mode  until 
a new  mode  is  selected  on  the  air  speed  controller. 

Flow  diagrams  presented  in  Figures  123.  124.  123,  126,  ,m.i  127 

of  appendix  A illustrate  the  complete  documentation  of  ILS  glideslope 

mode. 


125 


3.6.1 


Precapture  and  Idle  Modes 


3.d2 


The  purpose  of  the  idle  rrode  is  to  compute  when  to  start  the  qli de- 
slope Kalman  filter  and  the  glideslope  alaorithm.  This  occurs  when  the 
glideslope  deviation  is  less  than  120.0u^\  and  the  localizer  mode  is 
not  in  manual  heading,  at  which  time  the  glideslope  mode  is  switched 
from  idle  to  precapture. 


The  precapture  mode  performs  all  computations  of  the  glideslope 
algorithm  and  computes  the  capture  trip  point.  The  transition 
from  capture  to  track  will  occur  when  either  1)  the  VBS  override 
is  set  or  2)  the  estimated  beam  deviation  is  less  than  35.0uA. 

FiKures  123,  124,  and  126  illustrate  the  idle  and  pre-capture 

modes,  respectively. 

Capture  Mode 

The  capture  mode  controls  the  aircraft  during  the  capture  phase  of 
glideslope.  The  computational  algorithm  (equation  3.29  and 
Fipiires  126  and  127  ) for  the  capture  mode  pitch  command  will  cause 

GDF  = EXP(-J0/2.0)*(GDF  - GDH)  + 6DH 
ATGSN  = GDF*SH/(  UO  + ATSW) 
ftPN  = SH*GH/(1.0  - COS(ATGSN)  ) 

TDC  = -VHTN/(3600.0*SIGN(RPN,  ATGSN)  ) (3.29) 

TC  = TC  + J0*TDC 

HPTR  = 3.0*(TC  - TM)  - 0.02*UF2 


the  aircraft  to  follow  a piece-wise  circular  path  until  the  track 
mode  is  engaged.  The  track  mode  is  engaged  once  the  estimated 
glideslope  deviation  becomes  less  than  iS.OuA.  Figure  125 
illustrates  the  capture  to  track  control  logic. 


3.6. 3 TracK  Mode 

The  track  mode  is  the  final  mode  of  the  glideslope  alaorithm  and 
provides  a pitch  command  (equation  3.30  and  virnrcs  126  nml  127 
) that  is  a linear  function  of  y and  y.  When  the  track  pitch 

TF15  = EXP(  -JO/15. 0 )*(  TF15  - TM  ) + TM 
TF15C  = TM  - TF15 

AEOl  = KY*GH'*-(1.0  - VHTN/360.0)  (3.30) 

AEDl  = AEDl  = KY*(0.25*GDF  + 0. 75*GDH)/VHTN 
HPTR  = SH*AED1  - TF15C 

WHERE  KY  = r/lO  FT 

KY  = 1.5V10  FT/SEC 

TF15C  = PITCH  THROUGH  A 15  SEC.  FILTER 


command  is  implemented,  the  ai rcraft  ’vi 1 1 closely  track  zero 
estimated  beam  deviation. 

3.6.4  Range  Estimation 

I 

The  computational  algorithm  for  the  range  estimation  is  illustrated 
in  equation  3.31  and  ^ range  m,edsurenx?nt  is  computed 

from  the 


(3.31) 


SA  = Z/(  2.5°  - GH) 

SE  = SH  - T*VHTN*COS(ATGSN) 

SH  = 0.9*SE  + 0.1*SA 

Aircraft  radar  altitude.  The  computed  range  is  then  smoothed 
through  a predictor-correlator  type  filter. 

Wind  Estimation 

The  glideslope  wind  computational  algorithm  for  the  DFDC  follows 
directly  from  the  lateral  axis  wind  algorithm.  The  computational 
algorithm  is  based  on  computing  along  track  wind  only.  Equation 
3.32  and  Fieure  ]27  illustrates  the  computational  algorithm  and 
the  glideslope  wind  estimation. 

TFl  = EXP(  -J0)*(TF1  - TM)  + TM 
TDM  = TM  - TFl 

ATGSE  = ATGSN  + J0*TDM  (3.32) 

ATSE  = SH  - SHO  + T*VHTN*C0S (ATGSE ) 

ATSW  = ATSW  - 0.008-^ATSE/T 
VHTN  = UO  + ATSW 

SF.n  inN  n' 

Software  Design 

This  section  of  the  report  presents  an  indepth  discussion  of  the 
software.  The  Fortran  programs  were  the  design  median  for  the  DFDC 
software.  The  AED  programs  were  used  for  software  definition 
except  where  the  AED  lanquaae  could  not  express  the  desired  result. 

The  final  result  of  both  software  program  descriptions  is  the  assembly 
program  description  which  is  the  DFDC  software.  The  following  five 
modes : 

1)  Self  Test 

2)  Off 

3)  Manual  Heading 

4)  TACAN 

5)  ILS 

are  described  in  detail  in  paragraphs  4.1,  4.2,  4.3,  4.4,  and  4.5, 
respectively.  These  five  modes  are  each  selectable  via  the  air 
speed  controller.  Paragraph  4.6  contains  a discussion  on  mode 
control.  Paragraph  4.7  contains  a discussion  of  how  the  Kalman 
estimator  was  implemented.  Paragraph  4.8  describes  the  math  package 
required  for  the  system. 

The  system  specification  of  the  software  function  was  developed  via 
hybrid  simulation  in  Fortran  IV  using  floating  point  arithmetic.  At 
completion  of  the  hybrid  simulation  the  system  description  was  con- 
verted to  a detailed  AED  description  of  the  system  software.  The 
AED  description  was  then  hand  compiled  into  a machine  level  symbolic 
assembly  language  program  for  the  CAPS  (Collins  Adaptive  Processor 
System)  processor  being  used  as  the  digital  flight  director  processor. 
This  program  was  assembled  and  partially  tested  using  the  CAPS  assembler/ 
simulator.  Additionally,  the  AED  system  description  was  tested  by 
1108  simulation.  The  final  program  debug  was  performed  using  the 
digital  flight  director  static  test  bench  and  the  hybrid  simulator. 


In  addition,  hybrid  simulation  was  also  performed  in  Fortran  IV 
using  scaled  fraction  arithmetic,  to  verify  the  scaling  effort. 

The  system  software  has  been  structured  such  that  there  are  three 
stacks  implemented  in  the  machine  code.  These  stacks  are  as 
follows : 

1 ) Interrupt  Stack 

2)  Lateral  Axis  Stack 

3)  Longitudinal  Axis  Stack 

The  interrupt  stack  handles  all  I/O  processes.  The  lateral  axis 
stack  consists  of  Off  Mode,  Self  Test,  Manual  Heading,  TACAN, 
and  Localizer  computations.  The  longitudinal  axis  stack  consists 
of  glideslope  only.  The  time  required  to  complete  the  computational 
algorithms  for  each  mode  is  as  follows: 

STM.  OFF  - 5% 

Manual  Heading  - 15% 

TACAN  - 50% 

ILS  - 80% 

Where  the  % indicates  the  fraction  of  the  tenth  of  a second  allowed 
for  the  computation  of  the  indicated  function.  For  instance,  manual 
heading  mode  requires  only  15  milliseconds  to  convert  the  required 
inputs,  compute  a bank  command,  output  the  command,  and  return  to 
the  wait  loop. 

vii^iirp  illustrates  the  ILS  mode  timing;  Figure  128 

illustrates  all  other  mode  timing.  The  basic  computational  cycle 
beains  every  100  millisecond,  a sample  rate  of  10  times  per  second. 

A timed  interrupt  initiates  the  process.  After  sampling  the  required 
inputs  for  the  computation,  the  program  enters  a mode  control  sub- 
routine to  determine  which  computation  is  to  be  performed  (the  modes 
are  illustrated  in  FleureR  109  and  130  ).  Control  is  then  trans- 

ferred to  the  proper  computational  routine  which  computes  and  up- 
dates output  values.  Upon  completion  of  the  computation  the  pro- 
gram rests  in  a wait  loop  until  interrupted  for  the  next  cycle.  To 
avoid  large  delays  in  the  glideslope  computation  (between  input 
sample  time  and  output  update  time),  a 20-per.-second.  timer  is  used. 
The  glideslope  computation  is  performed  in  the  second  half  of  the 
100  millisecond  cycle,  if  the  DFDC  is  in  the  ILS  mode. 

If  an  illegal  address  occurs  during  operation,  machine  generated 
interrupts  will  cause  the  fail  warning  sub-routine  to  be  entered. 


This  sub-routine  will  set  FD  VALID  invalid  and  set  both  pointer 
flags  in  view.  If  other  error  conditions  occur  such  as  illeaal 
opcode,  stack  overflow,  and  others,  the  machine  will  stop. 


Software  costs  are  minimized  by  use  of  a high  level  language  to 
describe  the  problem  and  to  program  the  solution.  This  outside-in 
software  engineering  approach  provides  a processing  structure 
within  which  variations  are  economically  produced. 

A stack-oriented  machine  architecture  allows  efficient  compilation 
from  the  high-level  language  to  the  machine  code,  minimizing  pro- 
gram storage  space.  Even  if  machine  level  programming  is  done, 
the  programmer  is  relieved  of  most  of  the  addressing  and  memory 
allocation  problems  inherent  in  register  oriented  machines. 

Self  Test  Mode 

Self  test  mode  can  only  be  initiated  when  the  air  speed  controller 
is  in  the  cff  mode.  The  initiation  of  the  self  test  mode  either  by 
switching  to  self  test  on  the  air  speed  controller  or  pushing  the 
front  panel  push  button  will  cause  the  DF'DC  to  perform  internal 
tests  which  evaluate  the  units  integrity.  These  tests  are: 

1)  Deflection  of  the  VPTR  and  HPTR  one  quarter  of  an  inch  to 
the  right  and  one  quarter  of  an  inch  down.  The  outputs 
are  forced  to  this  position  by  the  computer  D/A  outputs. 
These  output  signals  are  also  multiplexed  to  the  A/D 
converter.  Digitized  and  interrogated  for  positional 
accuracy. 

2)  The  self  test  constant  is  requested  from  the  A/D  and 
compared  with  constants  stored  within  the  computer  to  test 
the  I/O  control  logic,  analog  multiplexer,  and  the  digital 
flight  director  bus  system. 

3)  The  execution  of  basic  arithmetic  and  reference/assign 
operations. 

4)  Program  sequencing. 

These  functions  are  illustrated  in  Figure  lio 
Off  Mode 

Off  mode  can  only  be  initiated  by  selecting  off  mode  on  the  air 
speed  controller.  When  the  DFDC  is  in  any  mode  other  than  the 
self  test  mode  certain  monitor  functions  are  performed: 

1)  A check  is  performed  to  determine  that  the  computations 

have  been  completed  in  the  time  allotted:  DONE  has  been 

set. 

2)  The  occurrence  of  an  invalid  address  or  opcode. 

Incorrect  operation  during  any  of  these  tests  results  in  actuation 
of  the  front  panel  failure  annunciator  and  a high  impedance  state 
at  the  DFDC  valid  output  - FD  VALID  light  is  off. 
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4.3 
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When  the  DFDC  is  in  the  off  mode,  the  HPTR  and  VPTR  are  biased  out 
of  view,  down  and  to  the  right. 

These  functions  are  illustrated  in  Figure  109. 

Manual  Heading  Mode 

Manual  heading  mode  is  engaged  by  switching  the  air  speed  controller 
to  manual  heading.  The  computational  algorithm  generates  a steering 
needle  command  consisting  of  manual  heading  error  times  a gain  term 
which  is  a programmed  function  of  air  speed  less  bank  angle. 

The  software  implementation  of  the  manual  heading  mode  follows 
directly  from  the  discussion  for  TACAN  manual  heading  design. 

This  function  is  illustrated  in  Figure  ill. 

4.4  TACAN  mode 

TACAN  mode  is  engaged  by  switching  the  air  speed  controller  to  TACAN. 
The  computational  algorithm  generates  a steering  needle  command  which 
will  1)  maintain  the  selected  heading  until  capture  is  engaged,  2) 
capture  the  TACAN  radial  via  a steering  needle  command  that  will 
cause  a piece-wise  circular  arc  to  be  flown,  3)  adequately  track 
the  TACAN  radial,  and  4)  maintain  the  selected  TACAN  radial  during 
the  overstation  mode. 

The  software  implementation  of  TACAN  follows  directly  from  the 
discussion  in  the  TACAN  design  section. 

These  functions  are  illustrated  in  Figures  112  through  118. 

4.5  ILS  Mode 

The  ILS  mode  is  engaged  by  switching  the  air  speed  controller  to 
ILS.  The  computational  algorithm  for  ILS  mode  generates  two 
steerina  needle  commands  which  are  HPTR  and  VPTR.  HPTR  displays 
a command  which  when  implemented  will  cause  the  aircraft  to  capture 
and  track  the  glides  lope  beam.  VPTR  displays  a command  which  when 
implemented  will  1)  maintain  the  selected  heading  until  capture  is 
engaged,  2)  capture  the  localizer  beam  via  a steering  needle 
command  that  will  cause  a piece-wise  circular  arc  to  be  flown,  and 
3)  adequately  track  the  localizer  beam. 

Tne  software  implementation  of  ILS  follows  directly  from  the 
discussion  on  the  ILS  design  section. 

These  functions  are  illustrated  in  Figures  118  through  127. 

4.6  Mode  Control 

Mode  control  is  illustrated  in  Figures  109  and  130. 


When  the  air  speed  controller  is  switched  from  one  mode  to  another 
mode,  the  processor  enters  the  off  mode,  executes  a re-start,  then 
enters  the  selected  mode. 


Kalman  Filter 


4 .7 


Since  the  Kalman  filter  can  be  described  by  four  matrix  equations, 
the  initial  preference  for  coding  it  was  to  implement  a generalized 
Kalman  filter  program  based  on  matrix  arithmetic  sub-routines  (trans- 
pose, add,  multiply,  etc.).  This  implementation  would  have  resulted 
in  a very  slow  computational  algorithm  as  well  as  usino  more  memory 
than  a "customized"  approach  would  have  required.  It  was, therefore, 
decided  to  "customize"  the  Kalman  filter  as  follows.  A software  sub- 
routine was  designed  to  perform  the  specific  operation  transpose 
(TRANS*M),  v/here  TRANS  is  the  transition  matrix  and  M is  some  other 
4x4  matrix.  This  sub-routine  is  called  twice  per  each  of  the 
three  Kalman  filters,  and  its  use  resulted  in  a reduction  of  the 
filter  calculations  memory  requirements  by  30%.  The  over-all 
Kalman  calculations  require  about  15  milliseconds. 

The  Kalman  filter  was  coded  using  double  precision  arithmetic 
instructions. 

The  Kalman  filter  algorithm  has  been  divided  into  two  parts.  These 
two  sub-routines ^are  1)  the  Kalman  gain  algorithm  and  2)  the  posi- 
tional vector  update  algorithm.  This  division  allows  more  efficient 
code  generation  and  allows  the  program  to  be  structured  easier. 

These  two  sub-routines  are  named  KFILl  and  KFIL2,  respectively. 

4.8  Math  Package 

In  addition  to  the  machine  arithmetic  instructions  discussed  in 
Section  III,  the  following  functions  have  been  implemented: 

1)  ABSOLUTE  VALUE 

2)  ARC  TANGENT 

3)  COSINE 

4)  LIMIT 

5)  SIGN 

6)  SINE 

7)  SQUARE  ROOT 

All  functions  are  16  bit  computations.  ABSOLUTE  VALUE,  LIMIT,  and 
SIGN  are  implemented  in  microcode.  The  other  functions  have  been  , 
implemented  by  sub-routines.  The  computational  algorithms  used 
are  described  briefly  below: 

ABSOLUTE  VALUE  (X) 

BEGIN 

ABS(X)  = IF  X GEQ  0.0  THEN  X ELSE  -X  $. 

GOTO  RETURN  $. 

END  ..  • 
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ARC  TAnGEr;T  (X) 

0 .LE.  X .LE.  1.0 

BEGIN 
X2  = X**2 

ATAN  = X*(  BO  + A1 

( X2  + B1  - A2 

{ X2  + b2  - A3 

( X2  )))  ) 

GOTO  RETURN  $. 

END 


WHERE 

BO  = 0.174655438  A1  = 3.709256262 
B1  = 6.762139240  A2  = 7.106760045 
B2  = 3.316335425  A3  = 0.264768920 
B3  = 1.448631538 


COSINE  (X) 


BEGIN 

COS  = 

SIN(  1 

mi  + 

X ) $. 

GOTO 

RETURN 

$. 

END 

LIMIT  ( L. 

X ) 

BEGIN 

LIMIT 

= IF 

{ ABS(X)  .GT.  L ) 

THEN 

SIGN( 

L.  X ) 

ELSE 

X $. 

GOTO 

RETURN 

$. 

END 

SIGN(  X.  S 

J. 

BEGIN 

SIGN  = MAGNITURE  OF  X WITH  SIGN  OF  S $. 
GOTO  RETURN  $. 

END 


132 


I 


BEGIN 

IF  ( PI/2  GRT  ABS(X)  ) THEN  GOTO  2 $. 
IF  ( X EQL  -PI/2)  THEN  GOTO  1 $. 

X = SIGN  ( 1.0  - ABS(X).  X ) $. 

IF  ( X EQL  1.0  ) THEN  GOTO  2 $. 

1 X = 0.999998*X 

2 X = X + X $. 

X2  = X**2  $. 

AEDl  = ( A3  + A4*X2  )*X2  $. 

AEDl  = ( A3  + A4*X2  )*X2  $. 

AEDl  = ( A2  + O.UAEDl  )*X2  $. 

AEDl  = (A1  + 0.1*AED1  )*X2  $. 

SIN  = X*(  AO  + AEDl  ) + X $. 

GOTO  RETURN  $. 


WHERE 

AO  = 0.1570796290 
A1  =-0.6459633598 
A2  = 0.7968848053 
A3  =-0.4672227919 
A4  = 0.0150820562 


SQUARE  ROOT  (X) 

BEGIN 

IF  X LES  0 THEN 
BEGIN 

SQRT  = 0 $. 

GOTO  RETURN  $. 

END  $. 

SQRTBIS  Y =0.5*  ( Y + X/Y  ) $. 

N N-1  N-1 

IF  Y LES  Y THEM  GOTO  SQRBI  $. 
N-1  N 

SQRT  = Y 

N 

GOTO  RETURN  $. 

END 
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SECTION  V 


5.0  Simulation  Studies 

Section  5.0  provides  a sun-^ry  of  the  simulation  results  performed 
during  the  development  and  support  phases  of  the  DFDC  program.  Paragraph 
5.1  presents  the  Kalman  estimator  simulation  results.  Paragraph  5.2,  5.3, 
and  5.4  contain  the  simulation  results  for  manual  heading,  TACAN,  and  ILS 
modes,  respectively. 

Figure  52  Illustrates  the  EAI  PACER  100  digital  computing  system  and 
Its  associated  peripheral  equipment.  This  sVstem  consists  of  a mag, 
tape  operation  system  with  a 16  bit,  32K  word  memory  and  a hardv/are 
floating  point  processor.  The  peripheral  equipment  consists  of  a CRT- 
dlsplay  with  keyboard  and  hard  copy  unit,  a card  reader,  and  a digital 
plotter.  The  on-site  availability  of  the  digital  plotter  adds  significantly 
to  the  ability  to  process  and  present  digital  data  in  a readily  under- 
standable form. 

Figure  53  Illustrates  the  digital  and  analog  computers  combined  with  an 
Interface  unit  between  them.  The  interface  unit  has  A to  D and  D to  A 
conversion  equipment  necessary  for  high  speed  data  transfer.  It  also  has 
logic  and  control  circuits  wnich  set  up  and  check  out  the  analog  computer. 
This  set-up  and  check-out  capability  of  the  analog  computer  by  the  digital 
insures  accurate  simulations  from  one  set-up  to  the  next.  This  is  an 
Important  feature  when  large  volume  and  fast  turn-around  times  are  needed 
as  In  the  case  for  the  simulation  facility. 

The  cockpit  Illustrated  in  Figure  54  Is  tied  to  the  hybrid  system  through 
an  interface  unit  which  converts  DC  voltages  to  required  low  level  DC 
voltages,  2-wire  AC  voltages  and  3-wire  AC  synchro  voltages,  and  is  used 
to  drive  the  ADI,  and  HSI  flight  instruments.  Information  from  the  cockpit 
column  and  rudder  pedals  is  fed  back  to  the  hybrid  system.  This  communica- 
tion between  the  hybrid  system  and  the  cockpit  simulator  provided  the 
means  to  put  a pllot-1  n-the-loop  for  hands-on  evaluation  of  the  DFDC  flight 
control  system. 

Figure  55  Illustrates  the  implementation  of  the  DFDC  hybrid  simulation 
in  the  simulation  facility.  The  PACER  100  digital  computer  modeled 
the  DFDC,  while  the  analog  computer  modeled  the  aircraft  and  the  real 
world  environment.  Preliminary  simulation  checkout  was  facilitated 
by  closed  loop  control  with  a simple  pilot  model.  However,  the  cockpit 
tie  Into  the  simulation  provided  the  final  check-out  of  the  man-in-the-loop 
for  the  DFDC.  The  simulation  was  digitally  controlled  via  the  graphics 
unit  and  the  key  board  input. 

Appendix  A Illustrates  the  analog  simulation  diagrams  for  the  composite 
aircraft.  Each  aircraft  simulated  in  this  study  was  set  from  this  analog 
simulation  diaoram  by  changing  potentiometer  settings.  Potentiometers 
were  set  autcmatically  from  IBM  cards  read  by  the  hybrid  system.  The 
hybrid  was  also  used  to  perform  aircraft  checkout  by  setting  up  check 
traces  under  program  control.  With  this  technique,  less  than  ten  minutes 
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FIGURE  54.  Cockpit  Facility 


was  required  to  convert  the  siriiulation  from  one  aircraft  to  another. 

The  standard  aircraft  distance  and  angle  definitions  are  illustrated 
Figure  37.  The  basic  geometric  relationships  for  ILS  localizer 

and  glideslope  are  illustrated  inripures  38  and  30  » respectively. 

Appendix  B contains  the  definition  of  system  variables  as  they  were 
implemented  in  the  computer  programs. 

One  of  the  objectives  of  the  DFBC  program  was  to  develop  computations 
which  were  relatively  insensitive  to  the  aircraft  dynamics.  In  order 
to  study  this  aspect  of  the  simulation  problem,  three  widely  differing 
aircraft  were  selected  from  our  aircraft  data  library  to  cover  the 
broad  spectrum  of  possible  future  system  installations.  These  aircraft 
included  a jet  transport,  a propeller  powered  aircraft,  and  a high 
performance  jet  aircraft.  The  jet  transport  is  typical  of  a large 
number  of  heavy,  swept  wing,  jet  aircraft  that  are  in  use  both  in 
civilian  and  military  applications,  This  aircraft  closely  resembles 
the  KC-135  tanker  aircraft  which  the  Air  Force  utilizes  extensively-  The 
propeller  power  aircraft  was  chosen  since  it  well  represents  the  large 
population  of  slov/er,  straight  wing  aircraft.  The  jet  aircraft 
represents  the  light  swept  wing,  high  performance  aircraft  end  of  the 
potential  user  spectrum.  This  type  of  aircraft  is  used  in  considerable 
quantity  by  the  Air  Force. 

Kalman  Estimator 

The  hybrid  simulation  results  of  the  Kalman  estimator  performance 
are  Illustrated  in  Figures  56  through  62  . The  relationship  of  these 

figures  is  illustrated  in  the  following; 
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BEAM  NOISE 
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zero 
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4.81uA 

lOE-19 

56D,  57C-,  61. - 

4.55uA 

lOE-7 

56E,  57D,  62 

5.59uA 

lOE-6 

Figure  56  illustrates  the  capture  and  track  of  five  ILS  localizer 
approaches  for  different  beam  noise  levels  and  values  of  R.  . Figure  57 
illustrates  the  data  sequence  of  the  four  sampled  noise  beams.  Figures 
58,  59,  60,  61,  and  62  illustrate  the  dynamics  of  the  Kalman 

gains,  K,  and  the  data  sequence  of  the  state  vector,  Xk.  The  intent  of 
these  simulation  results  is  to  illustrate  the  effect  ^of  varying  R.  ^ the 
measurement  noise  covariance  matrix,  has  on  the  Kalman  estimator  ana  its 
response.  provides  the  estimator  with  infonnation  relative  to  the 
signal  to  noise  ratio  of  the  incoming  beam  data.  As  R|^  is  increased,  the 
Kalman  gains,  R|^,  are  decreased.  The  result  of  increasing  R|^  and  decreasing 
K|^  is  illustrated  in  Figures  56  nlimugii  67  Examining  the  figures  will 
demonstrate  that  increasing  Rj^  from  zero  removes  the  high  frequency  noise 
content  from  the  estimated  beam,  beam  rate,  and  HPTR,  and  the  Kalman  gains 
decrease  in  value.  The  particular  values  of  R|^  that  were  selected  for 
each  mode  were  presented  in  section  3.0. 


Manual  Heading 


The  hybrid  simulation  results  for  manual  heading  mode  are  illustrated 
in  Figures  63  through  66  . These  hybrid  simulation  results  demon- 
strate satisfactory  performance  of  the  manual  heading  mode  of  the  DFDC  for 
the  three  aircraft  at  three  different  airspeeds.  Each  aircraft  v/as  flov/n 
in  a disturbance  free  environment  for  a manual  heading  of  zero  degrees 
to  + 50°  and  for  zero  heading  error  containing  6 gust.  On  close  examination 
of  these  simulation  results,  it  is  observed  that 

1)  For  the  disturbance  free  case,  s equaled  zero,  the  aircraft 
turned  to  the  selected  heading  radial  and  acquired  the 
radial  with  little  or  no  overshoot. 

2)  For  the  disturbance  case,  eg  not  zero.  The  aircraft  tracked 
zero  heading  error  with  satisfactory  performance. 

3)  At  200  knots  or  less,  PHIC  = heading  error. 

The  aircraft  will  be  commanded  to  roll  off  the  bank  limit 
of  30°  at  a heading  error  of  30°. 

4)  At  350  knots,  PHIC  = 2*(heading  error). 

The  aircraft  will  be  commanded  to  roll  off  the  bank  limit 
at  a heading  error  of  15°. 

5)  At  500  knots  or  more,  PHIC  = 3*(heading  error). 

The  aircraft  will  be  commanded  to  roll  off  the  bank  limit 
at  a heading  error  of  10°. 

6)  The  rate  limit  on  bank  command  is  5°/second. 

Figures  6s.  r,4,  67,  nnd  66  demonstrate  the  satisfactory  performance 

of  the  manual  heading  mode  for  the  DFDC  for  the  jet  transport  aircraft 
flying  at  496  knots,  the  jet  transport  aircraft  flying  at  125  knots.  The 
propeller  povjered  aircraft  flying  at  120  knots  and  the  jet  aircraft  flying 
at  150  knots,  respecti vely . 

TACAh 

Tne  heading  hold,  capture,  track,  and  overstation  performance  of  the 
DFDC's  TACAN  modes  are  illustrated  in  Figures  67  through  73  for  the 
jet  transport  flying  at  495  knots.  These  simulation  results  demonstrate 
the  satisfactory  performance  of  TACAN  mode.  The  TACAN  radio  beam  was 
captured  wi tn  a typical  overshoot  of  less  than  lOuA.  The  track  mode 
maintained  the  radio  beam  less  than  15uA,  typically. 

Perturbations  of  course  datum  and  di stance-to-station  are  illustrated 
in  Figures  67  through  70  These  simulation  results  demonstrate  the 
satisfactory  performance  of  TACAN  mode  as  follows: 

1)  The  bank  flown  during  the  capture  maneuver  was  essentially 
a constant  value. 
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ILS  localizer  v/i  th  a jet  transport  aircraft  flying  at  125  knots  for  i; 

5,  10,  15,  and  20  NM,  respectively  from  threshold  (glideslope  f 

antenna).  These  hybrid  simulation  results  illustrate  the 

satisfactory  performance  of  the  ILS  localizer  maneuvers.  |: 

Figure  78  illustrates  the  performance  of  the  DFDC  algorithm  for  90° 

captures  at  various  ranges.  The  performance  of  the  captures  and  track  i 

was  satisfactory.  Captures  of  7,  6,  5,  4,  and  3 TM  had  the  initial 
heading  changed  from  90°  to  80°,  70°,  65°,  and  45°,  respectively,  so 
that  a reasonable  overshoot  would  be  maintained. 

Figure  79  illustrates  the  effect  of  a 30  knot  cross  wind  with  beam 

noise,  these  simulation  results  demonstrate  the  satisfactory  performance 

of  the  DFDC  capture  algorithm  with  a cross  wind.  Analog  track  wind  j 

has  little  effect  on  the  capture  and  track  performance.  | 

Figure  an  illustrates  the  effects  of  a 30  knot  cross  wind  with  beam 
noise  and  gust.  These  simulation  results  demonstrate  the  satisfactory 
performance  of  the  DFDC  capture  and  track  algorithm. 

5. 4. 1.2  Propeller  Powered  Aircraft  - 120  knots 

Figures  8i  through  8S  illustrate  the  performance  of  the  DFDC  ILS 
algorithm  for  heading  hold,  capture,  and  track  modes  for  the  ILS 
localizer  with  a propeller  powered  aircraft  flying  at  120  knots  for 
various  heading  intercept  angles  and  iterations  of  distance  (ATD)  of 
5,  10,  and  15  Nh  respectively,  from  threshold.  These  hybrid  simulation 
results  illustrate  the  satisfactory  performance  of  the  ILS  localizer 
maneuvers. 

Figure  84  illustrates  the  effect  of  a 30  knot  cross  wind  with  beam 
noise.  These  simulation  results  demonstrate  the  satisfactory  performance 
of  the  DFDC  capture  algorithm. 

Figure  85  illustrates  the  effects  of  a 30  knot  cross  wind  with  beam 
noise  and  gust.  These  simulation  results  demonstrate  the  satisfactory 
performance  of  the  DFDC  capture  and  track  algorithm. 

.4.1.3  Jet  Aircraft  - 150  knots 

Figures  88  through  92  illustrate  the  performance  of  the  DFDC  ILS 
algorithm  for  heading  hold,  capture,  and  track  modes  for  the  ILS 
localizer  with  a jet  aircraft  flying  at  150  knots  for  various  heading 
intercept  angles  and  iterations  of  distance  (ATD  of  5,  10,  15,  and  20  N!1 
respectively,  from  threshold.  These  hybrid  simulation  results  illus- 
trate the  satisfactory  performance  of  the  ILS  localizer  maneuvers. 

Figure  pi  illustrates  the  effect  of  a 30  knot  cross  wind  with  beam 
noise.  These  simulation  results  demonstrate  the  satisfactory 
performance  of  the  DFDC  capture  algorithm. 

Figure  illustrates  the  effects  of  a 30  knot  cross  wind  with  beam 
noise  and  gust.  These  simulation  results  demonstrate  the  satisfactory 
performance  of  the  DFDC  capture  and  track  algorithm. 
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The  effects  of  airspeed  on  the  capture  maneuver  are  illustrated  in 
Figure  90  , The  airspeed  was  varied  from  120  knots  to  240  knots  in 
10  knot  steps.  These  simulation  results  demonstrate  the  adaptability 
of  the  circular  capture  algorithm  to  airspeed  perturbations. 

.2  ILS  Glides  lope 

Figures  93,  94,  and  95  illustrate  the  performance  of  the  DFDC 

ILS  glideslope  algorithm  for  glideslope  capture  and  track  for  the 
jet  transport,  the  propeller  powered  aircraft,  and  the  jet  aircraft, 
respectively.  The  hybrid  simulation  results  demonstrate  the  satis- 
factory performance  of  the  glideslope  capture  and  track  modes  with  and 
without  beam  noise  and  wind  as  follows: 

1)  Part  a of  the  figures  demonstrate  that  for  no  disturbances 
the  aircraft  has  commanded  to  capture  and  track  the  glideslope 
beam  within  10  ft.  At  threshold,  the  radio  deviation  had  a typical 
value  of  25uA. 

2)  Parts  b and  c of  the  Figures  demonstrate  that  a 30  knot  along 
track  wind  had  little  effect  on  the  performance  as  compared  to 
the  no  wind  case  (part  a). 

3)  Parts  d,  e,  f,  g,  and  h of  the  Figures  demonstrate  the  satis- 
factory performance  of  the  DFDC  for  increasing  glideslope  beam 
noise  levels. 


143 


Figure  56.  Kalman  Fstimator  Performance  - Beam  Votse  Studv 
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Figure  64,  Manual  Heading  Mode  - Jet  Transport  - 125  Knots 


Manual  Heading  Mode  - Jet  Aircraft  - 150  Knots 


Figure  68.  TACAN  Mode,  AID  = 100  NM, 


Figure  691 


Figure  71.  TACAN  Mode,  ATT)  = 70  NM 


Localizer  Mode,  Jet  Transport,  125  Ki 


Figure  77.  II,S  Localizer  Mode,  Jet  "transport,  125  Knots,  ATD  = 20  NM.Ay' 
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Figure  81.  ILS  Localizer  Mode,  Propeller  Powered  A/C,  120  Knots, 
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Figure  95.  1LS  Clldealope  Node  - Jet  Aircraft  - 150  Knota 
Wind  - itadlo  Note* 


MCTlOi  VI 


.0  riicio  TCST  HM.TS 

TW  VK  flifVt  tt«t  P'OV'lM  C0i>«iitt4  of  Hint  f 119(11  Uttt 
by  Colltat  fii9tii««rt«9.  IM  ii«it  Ml  iaiUl1c4  in  t«»  *«r  forct  1')b 
•Ircrtft,  no\.  603478  «ntf  603481.  M%tr  iMtv*X0Mir<t  HOmI 

fb4«<M9  problem  Mrt  re«el*«4  «nd  4 lov>C  error  kot  correctcb  l« 
OfDC,  tH«  unit  perforerb  tO  «tll9A  iptcif icbOom  wim  reioUt  c«mM* 
robit  to  thoie  oeteineb  et  Collim  hybrid  uiniUlioh  Ucilitiei.  Iht 
foUOMln9  It  4 ChroiiolOQiCbl  tiMMry  of  the  flibht  Uit  pr09r«0. 


July  n,  1974  lUnbolph  478 

The  OfCC  Mt  tottolled  in  T«39  leriol  no.  603478  end  vrownd  chfcht  of 
the  eircreft  interconnect  «er*  conducted.  OurinQ  init  7119111  tett. 

It  wet  determned  thet  the  etrcreft  roll  ettitude  mi>uU  Mrv  eh«i«d 
Incorrectly  which  pronibited  proper  ooeretion  in  ell  fiiont  nodet.  7ne 
b«nk  tignel  pnetin9  wet  corrected  tne  foltouiiib  wee*  et  bondolph. 


4o9H4t  7,8.  1974 

The  eircreft  wet  flown  to  Coder  Reptdt.  end  e check  of  the  (ntrrconnect 
wet  perfomet  prior  to  flight  tetit.  With  the  roll  ettitude  corrected, 
the  OfOC  pcrfonned  tetitfectorily  in  tne  K4h  HX  node  end  tne  US 
treck  tuteode  (loceliter  end  dlidetloce).  Attomoit  et  locelfeer 
cepture  were  not  swccettfu).  The  ceute  of  tnit  problem  wet  determined 
to  be  e phete  reeertel  in  the  course  error  interconnect.  The  pneting 
wet  corrected  prior  to  tubtepuent  flight  tout.  Due  to  e feulty  eir* 
creft  one  receiver  TAC4N  cepturct  were  not  ettcooted. 


.September  5,6,  1974 

Flight  tests  et  Rendolph  4FB  on  September  5 revealed  thet  In  the  IIS 
mode  the  OFX  was  bycessing  the  localizer  capture  submode  end  proceeding 
directly  fron  the  I’M  kX  submode  to  the  track  subnodc.  This  was  the 
result  of  a logic  error  in  the  mode  selection  subroutine.  It  ms 
possible  to  correct  this  problem  for  the  Sertecoer  6 flight  test 
by  reversing  polarity  on  the  glideslope  input  and  pitch  steering  pointer 
output. 

On  September  6,  the  DFDC  coimanded  acceptable  caotures  of  the  tlS 
localizer  beari  at  initial  course  cuts  of  <5  and  90  degrees.  ILS  tracking 
was  successful  in  both  localizer  and  glidesicpe.  The  OFOC  also 
cocmanded  successful  lACAU  captures;  however  tract  oerforrance  was 
not  considered  satisfactory.  Although  capture  suCnodes  of  ILS  and  TACAh 
directed  tne  aircraft  to  the  bean  with  acceptable  overshoot,  the  bank 
angle  comanded  tended  to  be  shallow,  nonrally  less  than  10^  for  45^ 
Intercept  angles.  The  cause  of  this  problem  was  not  detemined  due  to 
limitations  of  time  and  available  egulpraent. 
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October  3.  4.  1974 


Prior  to  th«ie  flight  tests,  one  progr«rr4b1e  re4d  o«!y  nenory 
located  on  the  A6  card  assembly  was  reprograrred  to  reverse  glide' 
slope  phasing.  This  corrected  the  node  selection  logic  #nd  permitted 
the  OFOC  to  enter  the  capture  routines.  Attenpcs  were  nade  prior  to 
flight  tests  by  the  Air  Force  and  Collins  to  obtain  an  airborne  re> 
corder  for  troubleshooting.  A suitable  recoroer  was  not  available  and 
it  was  therefore  not  possible  to  monitor  OfOC  inputs  during  the  tests. 

The  OFOC  operated  successfully  in  all  nodes  during  flight  tests  con> 
ducted  on  both  days.  TACAM  tests  included  low  and  high  speed  captures 
at  large  and  snail  intercept  angles.  Tne  capability  of  the  unit  to 
select  a new  outbound  r«dia1  in  TACAX  overstaiicn  was  dennnstrated. 

ILS  local iaer  and  glideslope  captures  at  low  speed  shallow  intercept 
angles  and  high  speed  large  intercept  angles  t>ere  also  demonstrated. 

In  the  ILS  track  node,  radar  altitude  gain  programing  performed  to 
design  specifications. 

Ounng  the  fli^t  tests,  two  apparent  undesirable  characteristics 
were  noted:  1}  The  bank  ancle  connands  during  localizer  and  TACAN 

capture  were  less  tnan  8”.  This  did  not  inhibit  capture  of  the  beam, 
but  resulted  in  long  shallow  captures.  2)  On  two  approaches,  the 
OFOC  contnands  resulted  in  "S^ing  along  the  bean  until  glideslope  cap- 
ture. It  appeared  that  these  conditions  were  caused  ty  either  incorrect 
scaling  of  the  course  error  reference  voltage  or  by  improper  radio  load- 
ing. The  actual  cause  v/as  not  determined  since  adeouate  recording  eguip- 
nent  was  not  available.  The  aircraft  project  schedule  did  not  permit 
additional  flight  director  tests.  It  was  therefore  decided  to  install 
the  OFOC  in  a second  T-39. 

Hovember  22,  23.  1974 

Preparations  \xre  made  during  the  week  of  October  21  at  Randolph  AFC  with 
Collins  engineering  support  to  install  the  OFOC  in  the  second  T-39  air- 
craft serial  no.  603461.  Particular  attention  was  oiven  to  the  course 
error  reference  voltage  derived  froo  the  115V  400  HZ  aircraft  po»/er  and 
radio  loading  to  eliminate  the  shallow  bank  comands  and  *‘S"ing  experi- 
enced durino  jrevious  flight  tests.  Collins  was  able  to  Supoly  an  eight 
channel  recorder  to  document  DFDC  operation.  Data  gathered  durino  the 
tests  is  shown  in  Figures  9h  thru  99  *. 

After  a preliminary  ground  check  of  the  PAN  HOG  and  ILS  mode,  flight  tests 
were  conducted  on  November  22.  The  DFDC  operated  In  these  two  nodes, 
successfully  executed  circular  caotures,  and  did  not  exhibit  the  shalloiy 
uank  commands  experienced  previously.  During  the  flight  tests.  It  v/as  not 
possible  to  display  radio  information  on  both  cockpit  MSI's  simultaneously. 
To  alleviate  this  problem  the  IK  ohm  load  resistors  on  the  TAC  dev  and 
localizer  flag  inputs  within  the  DFDC  were  removed.  Attempts  to  capture 


♦ The  horizontal  axis  (time)  is  scaled  5 sec/major  division  in  Figures 
96  through  lOfi  . 
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TACAh  were  unsuccessful.  Crouno  checks  reveeled  that  the  D*1C  reference 
voltage  was  less  than  antlcioateo  In  this  aircraft,  causing  irprooer 
operation  of  the  DUE  denodulators.  The  removal  of  an  attenuation  re- 
sistor within  the  OFOC  allowed  the  demodulators  to  function  normally. 

After  a concerted  effort  to  correct  radio  loading  in  the  aircraft, 
flight  tests  were  conducted  on  liovember  23.  The  unit  performed  to 
design  specifications  in  all  modes,  executed  circular  captures  without 
exhibiting  shallov/  bank  connands  and  tracked  the  ILS  and  TACAN  radio 
beams  with  a maximum  error  at  20ua.  Performance  achieved  is  summarized 
in  Table  9 . 


March  3-10,  1975 


Engineering  support  and  recording  equipment  were  provided  at 
Randolph  AFB  during  the  week  of  ^rch  3 for  verification  and 
documentation  of  DFDC  in-flight  performance.  During  this  week; 
two  aircraft  problems,  which  caused  intermittent  system  operation, 
were  located.  The  roll  gyro  behaved  erratically  around  zero  with 
output  deviations  of  3 to  10^  from  true  attitude.  This  problem 
was  reduced  by  replacing  the  roll  gyro,  but  was  not  completely 
eliminated.  A loose  localizer  channel  interconnect  wire 
was  located  in  the  project  junction  bpx.  This  problem  caused 
intermittent  mode  switch  inhibiting,  in  the  ILS  submodes.  The 
loose  connection  was  corrected  and  normal  ILS  operation  resuned. 

The  OFDC  performed  to  design  specifications  as  shown  in  Figures  lon 
and  101*  during  most  captures.  However,  an  apparent  instability 
in  the  system  caused  the  OFDC  to  command  an  “S“ing  down  the  localizer 
beam  during  several  capture  attempts. 

The  computer  was  returned  to  Collins  and  interfaced  to  the  hybrid 
simulation  facility.  A concerted  effort  was  undertaken  to  recreate 
the  characteristics  observed  during  flight  tests.  A tho'xiugh 
examination  of  the  data  obtained  from  the  flight  tests  revealed  that 
the  instability  or  "S“ing  occurred  at  times  when  the  pilot  was  not 
maintaining  the  bank  steering  pointer  at  zero.  By  approximating  this 
condition,  the  instability  noted  in  flight  was  evident  under  simulation. 
The  effects  of  this  phenomena  were  minimized  by  modifying  the  localizer 
track  law.  The  track  law  modification  consisted  of  reducing  bank 
coirmand  due  to  bean  deviation  which  increased  bank  command  response 
as  a function  of  beam  rate. 

This  modified  track  law  was  implemented  in  the  DFDC  by  changing  one 
constant  which  required  reprogratiming  four  PROMS.  Further  simulation 
was  conducted  to  verify  the  increased  stability  and  to  insure  that 
the  modification  did  not  result  in  decreased  performance. 


March  18-21,  1975 

Tne  DFDC  was  returned  to  Randolph  with  the  modified  program  card 
installed  and  flight  tests  were  conducted  with  recording  equipment 
for  four  additional  days.  The  flight  tests  demonstrated  successful 
operation  and  stability  in  all  modes  confirming  the  simulator  results 
obtained.  Data  collected  during  this  last  week  of  flight  tests 
is  shown  in  Figures  102  through  108  *.  Performance  attained  during 
the  March  flight  tests  is  summarized  in  Table  10  . 

System  performance  is  best  illustrated  in  Figures  06  through  im 
and  108  where  the  bank  steering  pointer  was  maintained  near  zero  during 
capture  and  track. 


* The  horizontal  axis  (time)  is  scaled  5 sec/major  division  in 
Figures  96  through  108  • 
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Figure  108.  Flight  Test  Data  - TACAN 
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6.1  Deviations  From  the  Ideal 


It  is  the  purpose  of  this  section  to  describe  effects  on  performance  of 
the  DFDC  during  flight  tests  caused  by  equipment  limitations;  the  lack  of 
a Central  Air  Data  Computer  (CADC),  and  a radar  altimeter  of  limited  range 
(0  to  1,000  feet). 

6.1.1  Airspeed  Inputs 

The  software  variable  U , used  as  true  airspeed  in  the  DFOC  control  law 
programs,  is  set  equal  to  either  the  airspeed  entered  on  the  Airspeed  Controller 
or  the  true  airspeed  output  from  the  CADC  and  is  selected  by  means  of  a toggle 
switch  on  the  controller  panel. 

U is  used  for  initialization  of  crosstrack  rate  in  the  Kalman  filter,  for 
tne  computation  of  the  circular  bank  command,  for  integration  in  the  range 
estimation,  and  for  gain  programming  in  the  manual  heading  control  law. 

If  a CADC  is  provided  so  that  true  airspeed  is  sent  to  the  DFDC,  then  an 
accurate  indication  of  true  airspeed  would  be  available  and  would  result  in 
an  optimum  performance.  If  the  manual  airspeed  is  selected  via  the  airspeed 
controller  and  the  manual  airspeed  is  not  set  to  the  correct  value,  then  the 
DFOC  will  not  perform  optimally.  The  degradation  in  performance  will  be  a 
function  of  the  error  in  the  manual  airspeed  setting. 

The  effect  of  improper  manual  airspeed  setting  on  the  gain  programming  for 
the  heading  control  laws  for  too  high/low  a setting  would  result  in  too 
high/low  a gain  heading  error.  This  would  result  in  too 
high/low  a value  of  bank  attitude  for  a given  heading  error. 

Error  in  manual  airspeed  will  result  in  a proportional  amount  of  error  in 
the  initial  Kalman  filter  position  rate  term.  However,  as  the  filter  is 
updated,  the  rate  term' will  settle  to  the  correct  estimate  since  the  wind 
estimator  will  compensate  for  any  errors.  The  resulting  effect  on  per- 
formance of  the  capture  submode  will  be  minimal. 

Incorrect  manual  airspeed  setting  will  effect  the  range  estimation  algorithm 
and  therefore  performa-nce  in  the  track  submode.  A too  high/low  airspeed 
setting  will  result  in  a too  low/high  range  estimation.  This  will  increase/ 
decrease  the  gain  programming  on  the  bank  command,  resulting  in  increased 
bank  activity/reduced  tracking  performance. 

6.1.2  Radar  A1  titude 

The  DFOC  was  designed  to  interface  with  a radar  altimeter  with  a range  of  0 
to  5,000  feet.  The  radar  altimeter  provided  with  the  aircraft  used  for 
flight  tests  had  a range  of  0 to  1000  feet  requiring  a modification  to  the 
DFOC  analog  scaling  receiver  provided  for  this  input. 

The  radar  altimeter  provides  altitude  information  utilized  to  perform 
a 1 inearization  of  the  glideslope  beam.  Radar  altitude  is  also  used  to 
perform  an  update  on  the  localizer  range  estimation  once  the  glideslope  beam 
has  been  acquired.  Effect  on  localizer  tracking  due  to  incorrect  altitude 
information  is  minimal. 
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For  a 0 to  5000  foot  altimeter  the  glideslope  capture  and  track  performance 
will  be  optimum.  The  conversion  to  the  0 to  1000  foot  altimeter  resulted 
in  accepting  degraded  performance  in  the  glideslope  mode  above  1000  feet. 
Where  the  gain  on  the  glideslope  control  laws  will  be  reduced  by  1000  feet/ 
actual  altitude.  For  example,  at  2000  feet,  the  glideslope  gain  would  be 
reduced  by  50*.  This  reduces  the  outer  loop  gains  and  results  in  "loose" 
tracking  of  the  glideslope  beam. 

6.1.3  Roll  Rate  Limit 

The  DFDC  was  designed  to  perform  on  all  aircraft  from  high  performance  jet 
fighters  to  large  transports.  The  roll  rate  limit,  established  for  all 
modes  at  5 degrees  per  second  in  consideration  of  the  flight  profile  of 
a transport  aircraft,  was  considered  to  be  acceptable  for  a jet  fighter 
under  instrument  flight  conditions.  During  flight  tests,  pilots  commented 
that  roll  rate  was  too  low  and  the  following  roll  rate  limits  were 
recommended : 

ILS  Approach  - 2.5  degrees  per  second 

TACAN,  ILS  Capture  Modes  - 7.5  degrees  per  second 

Manual  Heading  - 10  degrees  per  second 

In  tlie  approach  mode,  2.5  degrees  per  second  will  not  support  the 
improved  performance  provided  by  the  DFDC.  The  following  would  be 
required  to  modify  the  roll  rate  limits  in  capture  and  manual  heading 
modes: 

1)  The  addition  of  two  constants  in  DFDC  memory. 

2)  The  addition  of  a subroutine  to  replace  the  present  rate 
limit  instruction,  capable  of  determining  mode  and  selecting 
the  correct  constant. 

3)  Verification  of  performance  with  an  external  memory  and  the 
Collins  Hybrid  Simulation  Facilities. 

4)  The  replacement  of  approximately  eight  programable  read-only 
memories. 


t. 
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Figure  109.  Walt  Loop  and  Off  Mode  Control 
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Figure  111.  Manual  Headlnf;  Mode  Control 
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Manual  HeadlnR  to  Capture 
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Figure  114.  TACAN  Capture  to  Track 


Figure  IIS.  TACAN  Track  to  Overstation 
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Figure  116.  TACAN  Overstation  to  Capture 
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Flp.ure  117.  TACAN  Mode  Tontrol 
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QL(2)  z 2.0^^QL02 

IF  [ IT  .GT.  25  ] QL(2)  = 0.0053kQL02 
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FiRure  119.  DME  RanRe  Smoothinp  AlRorlthm 
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Figure  123.  GS  Idle  to  Pre-capture 
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Figure  124.  GS  Pre-capture  to  Capture 
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SICN'SP«Ct1,' 
II.  - CBSlfn 
i'll 

EC  » JC«TCC 
- 3ITC  - Tr)  - 
.2«UF2 


HPTR  : T3CR  • ^CCR 
TCCRT  O.SSS.ECCR 


Figure  126.  Glides lope  Mode  Control 


filS  = EXP(  -JO  ) 

IF  ( GSCORT  ) R15  r EXP(  -JG/15  ) 

TF15  = fllSwt  TF15  - TM  ) + TM 
TF15C  = TM  - TF15 

UFl  = EXP(  -JO/63  )*(  UFl  - Uo  ) + Uo 
UFIC  = Uo  - UFl 

UF2  : EXP(  -JO/S. 3 )*(  UF2  - UFIC  ) + UFIC 
SHO  r SH 

Sfl  r Z/(  2.5“-  GH  ) 

SE  = SH  - T*VHTN*COS(  RTGSN  ) 

SH  = 0.9*SE  + 0.1*Sfl 

IF  ( 0.0  .GT.  SH  ) SH  = 0.0 

TFl  r EXP(  -JO  )*(  TFl  - TM  ) + TM 

TFIC  = TM  - TFl 

flTGSE  : flTGSN  t-  JOkTFIC 

RTSE  r SH  - SHO  + T*VHTNkCOS(  RTGSE  ) 

RTSW  = RTSW  - 0.008*RTSE/T 
VHTN  r Uo  + RTSW 
FK  = -3600*VHTM*TF1C/SH 
IF  t GSIT  .NE.  01  CALL  KFIL2(  TRGS.  XKGS. 
1.0,  0.25*GM,  FK,  SDUMG,  CDUMG  1 

GSIT  = 1 
GH  : XKG(l) 

GOH  = XKGI21 

GDF  = EXPl  -JO/2  )*(  GUF  - GDH  1 t GOH 
RTGSN  = -GDH*SH/(  Uq  + RTSW  1 


FI  etire  127.  Gllfleslopp  Common 
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INTERRUPT  MODE  USER  MUD 


A 


Figure  130.  Mode  Control 
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fHIS  APPENDIX  CONTAINS  the  OEPINITIQN  OF  VARIABLES  COOED  IN  THE 
SOFTWARE  programs  ANO  ILLUSTRATED  IN  THE  FLOH  CHARTS, 

DEFINITIONS 

general  terhs 

AEDl  DiJHMy  variable 

AE02  OUH‘^Y  variable 

AF.D5  Dummy  variable 

OTR  DEGREES  TO  RADIANS  CONVERSION  CONSTANT 

G GRAVITY 

GSA  5/S  BEAM  angle 

JO  sample  time,  seconds 

T sample  TIME,  HOURS 


BASIC  AIRCRAFT  TERMS 

GAM  lateral  flight  PATH  ANGLE 

GGAM  G/S  FLIGHT  PATH  ANGLE 

GM  G/S  beam  deviation,  MEASURED 

GnF  G/S  beam  deviation,  NOISE  FREE 

HH  HEADING  angle  TO  BE  FLOWN 

PSI 

PSIECR  COURSE  DATUM  ERROR 

PSIECRS 

RSIEMH 

PSIEMHDG  manual  heading  ERROR 
PHI  BANK  angle 

QM  LATERAL  BEAM  DEVIATION, 

QnF  LATERAL  BEAM  DEVIATION, 

RANGE  Range,  RADIAL 

TOM  PITCH  RATE,  measured 

TM  PITCH  angle,  measured 
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measured 

NOISE  FREE 


UO  4I«8PEE0 

X ALOKG  TRACK  DISTANCE  TO  THRESHOLD 

XD  ALONG  TRACK  RATE 

Y CROSS  TRACK  DISTANCE 

YD  CROSS  TRACK  RATE 

z altitude 


lateral  axis  terms 


415 

ATF. 

ATi* 

AY 

CTi*) 

CTE 

Cr.H 

O'vM 

OQr-1 


dummy  variable 

ALONG  TRACK  ERROR  (>«iIND  COMPUTATION) 

ALONG  TRACK  wiMO 

gain  adjustment  used  in  the  PREDICTOR/CORRELATOR  P PILTE^t 
CROSS  track  aIND 

CROSS  TRACK  ERROR  (WIND  COMPUTATION) 
cosine  op  i»!lNO  (INTERMEDIATE  QUANTITY) 
dummy  variable  for  PASSING  RH 
DUMMY  variable  for  PASSING  Qm 


FIRSTIMP  PIRST  TIME 

game  gamma,  predicted,  , USED  IN  WIND  MEASUREMENT 

Gamm  gamma,  best  estimate,  , ANGLE  TO  VELOCITY  VECTOR 

Ghh  gain  prcGRAMming  term  FOR  HEAOIN  HOLD  MODE 

IT  ITERATION  TIME,  USED  FOR  CAPTURE  DETERMINATION 

KCTE  SCALING  TERM  FOR  CTE 

KSCALI  SCALING  constant  1 

KSCAL2  scaling  constant  2 

I.ATSW  lateral  axis  Switch 

wC  cross-track  MiNO  filter  coefficient 

MODE  “OOe,  DESIRED  - STm,  OFF,  MAN  HOG,  TAC»  ILS 
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1 


MOOEUA 

OH 

PHIC 

PHICL 

PHICT 

PHII 

PHILAG 

PHOLO 

PL 

GOB 

QM 

QHO 

QL 

QL02 

OH 

PL 

OK 

SOM 

Sk>h 

T«L*T 

VHfi 

XMANHO 
T«C4'»  TEP«S 
40JPHL 
OMER 
G» 

0V5TP 


MODE  LATERAL  AXIS 

wiMD  angle,  best  estimate 

SANK  angle  command 
PHIC  CAPTURE 
PHIC  TRACK 

difference  between  PRESENT  AND  PREVIOUS  BANK  COMMANDS 
PHI  FILTERED 

LAST  VALUE  OF  PHIC,  USED  ID  DETERMINING  ROLL  RATE 

covariance  matrix 

BEAM  rate,  BEST  ESTIMATE 
BEAM  DEVIATION,  BEST  ESTIMATE 
PREVIOUS  value  of  QH 
disturbance  VECTOR,  NOISE 
9Lf2)  fixed  reference  VALUE 
RANGE,  BEST  estimate 
signal/noise  ratio  term 

DESIRED  ( COMPUTED  ) RADIUS  OF  CURVATURE  TO  BE  FLOWN 

DUMMY  variable  for  PASSINQ  QM 

SINE  OF  WIND  (INTERMEDIATE  QUANTITY) 

TRANSITION  MATRIX 

GROUND  VELOCITY,  BEST  ESTIMATE 

wind  MAGNITUDE,  BEST  ESTIMATE 

SUBROUTINE  TO  COMPUTE  MANUAL  HEADING  BANK  COMMAND 

SCALING  TERM  ON  PhICL  TO  TRIP  TO  TACAN  CAPTURE 
OME  range 

CAIN  programming  term  for  PHICT 
OVER  station  trip  POINT 
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PSIMOw 


Psi  PUTEPEO 


QM 

TGM 

TACAN  beam  deviation 

X2L 

Y,  filtered  XKL(2) 

XLd) 

XKL(R) 

XKL(3) 

XKu(a) 

CROSS  TRACK  DISTANCE,  BEST  ESTIMATE 
CROSS  TRACK  RATE,  BEST  ESTIMATE 
BEAM  ^nT0E,  BEST  ESTIMATE 
GUST  NOISE,  BEST  ESTIMATE 

XStL 

gamh,  filtered 

VDT 

CROSS  TRACK  RATE,  Y 

ILS  (LCC)  TEPMS 

AV  RANGE  filter  COEFFICIENT 

HPHic  PHI  coHMAKfc  oifferek'ce  to  be  washed  out  in  transition 

FROM  capture  to  track 

KY  SCALING  TERM  FOR  V FED  INTO  PHICT 

NA8LGS  ENABLE  G/S 

R4  MEASURED  RANGE  DERIVED  FROM  QOB 

RO  RANGE  difference  BETWEEN  RA  AND  RE 

RE  RANGE,  PREDICTED 

RHO  PREVIOUS  BEST  ESTIMATE  OF  RH 


XKU 

n ) 

BEAM 

posir 

ION,  BEST 

estimate 

XHL 

(?) 

BEAM 

RATE, 

BEST 

ESTI 

MATE 

xkl 

(3) 

BEAM 

NOISE 

, BEST 

EST 

ImaTE 

XKL 

(P) 

GUST 

NOISE 

, BEST 

EST 

ImaTE 

lCNGIT'JDI 

M 

AXIS  ( 

C/8  ) • 

TERMS 

ATGSE 

angle 

TO  G/S,  PREDICTED 

atgsn 

ANGLE 

TO  6/S,  BEST  ESTIMATE 

atsf 

ALONG 

TRACK  SLANT  WIND  ERROR 

ATSw 

ALONG 

TRACK  SLANT  WiNO 

CO'JMG 

dummy 

COLUMN  VECTOR 

GOF 

BEAM 

RATE,  FILTERED 

GOH 

BEAM 

RATE,  BEST  ESTIMATE 

236 


GH 


BEAM  DEVIATION,  BEST  ESTIMATE 


GSCnftT  G/S  CAPTURE  .OR,  TRACK 

G8IT  G/S  ITERATION  TIME 

GSS«^'  G/S  SMITCM 

KATS'*'  scaling  COnSTAnjt  EOR  ATSw 

PG 

PGS  COVARIANCE  matrix 

3G 

GGS  disturbance  VECTOR,  NOISE 

RG  S/N  RATIO  TERM 

RPN  RADIUS  OE  curvature  FOR  G/S  PITCH  CAPTURE  COMMAND 

SA  SLANT  range,  measured 

SE  SLANT  range,  PREDICTED 

SH  SLANT  range,  best  ESTIMATE 

SMl  SLANT  RANGE,  IDEAL 

SOUMG  scaled  dummy  VARIABLE 

TOC  PITCH  rate  command,  CAPTURE 

TOCA  PITCH  command,  track 

TOCAT  pitch  CO^'manD  DIFPEBEnCE  TO  BE  WASHED  OUT  IN 

TRANSITION  FROM  CAPTURE  TO  TRACK 

TC  PITCH  CP‘*“AnD,  capture 

TFl  PITCH,  FILTERED 

TFIC  PITCH  rate 

TP15  PITCH,  filtered 

TPI5C  PITCH  RATE 

tranGS 

TRGS  TRANSITION  *'ATRIX 

UFI  UO,  FlLTEO 

UF?C  UC  PATE 

UP? 


UO  acceleration 


1 o 


1 


VHT\  VELOCITY  TANGE^JT  TO  RPM,  BEST  ESTIMATE 

XK6 

X»<GS  POSITIOK'  VECTOR,  BEST  ESTIMATE 

YKGS(l)  BEAM  POSITION,  BEST  ESTIMATE 

XKGS(2)  BEAM  rate,  BEST  ESTIMATE 

*i<GS(3)  beam  noise,  BEST  ESTIMATE 

XKGS(«)  GUST  noise,  best  ESTIMATE 


KALMAN  PIUTEB  terms 


COUM  DUMMY  COLUMN  VECTOR 

PK  ACCELERATION  FORCING  FUNCTION 

P COVARIANCE  matrix 

PP  COVARIANCE  matrix 

Q disturbance  VECTOR 

R NOISE  COVARIANCE  MATRIX,  MODELS  S/N  RATIO 

souM  scaled  dummy  variable 

TRANS  TRANSITION  MATRIX 

X<  PCSITION'  vector,  BEST  ESTIMATE 

ZK  POSITION,  measured 


C myBRIO  simulation  TERM8 


c 

AH 

ALT,  HOLD 

value 

c 

r 

HP15 

ALTITUDE  FILTERED 

V 

r 

HFlSC 

ALTITUDE  RATE 

w 

C 

lATSN 

CONTROL  TO 

SET 

ATSw  « 0 

I* 

r 

icount 

ITERATION 

COUNT 

, total 

w 

c 

r 

IGGAM 

CONTROL  TO 

SET 

ATGSN  3 G/S  GAM 

C 

IGH 

CONTROL  TO 

SET 

GH  a GM 

w 

C 

r 

IGDW 

CONTROL  TO 

SET 

GOH  B measured  beam 

RATE 

r 

IGH 

CONTROL  TO 

SET 

QH  m QM 

V 

1009 

CONTROL  TO 

SET 

0D8  TO  MEASURE  RATE 

value 

23fl 
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1 


ISH 

CONTROL 

TO  SET  SH 

1 s SHI 

ITAPE 

CONTROL 

FOR  WRITING  DATA 

TO  TAPE 

TMFl 

PITCH,  1 

FILTERED 

TMFIC 

PITCH  rate 

KFK 

scaling 

CONSTANT 

ENTERED 

VIA 

KEYBOARD 

KKCTW 

SCALING 

CONSTANT 

ENTERED 

VIA 

KEYBOARD 

ktdct 

scaling 

CONSTANT 

ENTERED 

VIA 

KEYBOARD 

ktdcc 

SCALING 

CONSTANT 

entered 

VIA 

KEYBOARD 

KRA 

SCALING 

CONSTANT 

ENTERED 

VIA 

KEYBOARD 

KUF2 

SCALING 

CONSTANT 

ENTERED 

VIA 

KEYBOARD 

SO 

SENSE  LINE  ZERO 

PPM 

real  value  of  rh 

(MOT  SCALED) 

THE  FOLLOt^IiwG  40E  HY8RI0  SYSTEM  SUBROUTINES 

QMON  MnNITOR  MAGNETIC  TAPE  HANDLER 

0P8A0S  INPUTS  A BLOCK  OF  A/0  VALUES,  SCALED 

QRSLL  READS  SENSE  LINES 

CSHYIN  IC  HYBRID  SYSTEM 

OSIC  PLACES  analog  computer  IC 

QSOP  PLACES  analog  COMPUTER  IN  OPERATE 

QSRUN  PLACES  analog  LOGIC  IN  RUN  MODE 

OSSECN  PLACES  analog  COMPUTER  IN  NORMAL  SECOND  (REAL  TIME) 

OSTOA  OUTPUTS  D/A  VALUE 

OwBOAS  0UT»UT8  A BLOCK  OF  D/A  VALUES,  SCALED 

OHJOAS  transfers  one  D/A,  SCALED 
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I^TEGE!?  GSS>*,  LATSw,  IT,  GSIT,  MODE,  mqDELA,  ITAPE,  IDA 
LOGICAL  SENSw,  SO,  FTlMf,  NjARlGS,  GSCORT 
DIMENSION  AOV(IH),  DA V ( A) , adMA (2) , D (5«) 

DIMENSION  TPANSUU.U),  PL(«,U),  XKL(«I,  KLCU),  OLCai, 

% BGni,  TPANSG(ii.u)  , PG(t*,<n,  XKG(O),  KG(ai,  QG(a3 
Cl  MANSION  XP(a),XM(«3 

peal 

peal  icruNT 

peal  J0,L,  JUU,KMM,KG,t<GO 
peal  <l,  *^02  , KOI , <Qa  , KRL 

peal  i<  A,K8,KAV 
»£al  uA,LC,Ky 
PEAl  <<HC,  LLATS* 

CO‘'MCN  X,FHl,)iC,2,TM,GGAM,  fiM,  TDM,XD, 

SPL,  CNF.T,  CL,  TOANSL,  K02,KQ3,KCP, 

IZ»<  ,'cD,V,QM,p-(,r,ot5,B4, 

lQM,CTE,CT».,ATE,ATW,'-NH,aH,VHG,PN,PMIC, 
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SPSI , GAM, game, G4M^,0wf,C0fc,OEB* 
iPAKGE,  ICOUM,  FK,  KL,  XKL,  PL » DUMMY, 

S PHICT,  PHICL.  QL02,  IQm,  ICTw,  Rho,  LC»  G» 

* PHII,  PWOLD,  jo,  IDA,  IT 
DATA  AONAn),AOKA(2)/aHOFDC,<lHDA  / 

data  mode  / 2 / 

DATA  ITAPE,  XJO,  LLATSw,  KHO,  IICTW,  IIRH,  IIOH,  IIODB,  ITOA 
S / 0,  0«il,  1*0*  IfO,  1,  0,  0,  0,  0 / 
data  ISM,  IGh,  IGOe,  lATSW,  NS 
$ / 0.  0,  0,  1,  PR99  / 

data  kPL  / 0,0005  / 

data  RGtn,  PG(2),  RG(3)  / 0,00025#  0,0005#  0,0001  / 

PRESETS 

ICTi^  3 IlCTW 
IPh  X IIPH 
10“  3 IIOH 
lOOS  3 IIQDB 
104  s IIOA 
GSA  B 0.041363325 
JO  8 XJO 
G s 6P62S.3679S 
PI  8 3,1M5926S3 

DU“MY  3 0,0 
Meu 

call  QSHY1N(IERR#680) 

call  QM0^(22, '165 
call  oMOMn^n 
call  I3''C^^5I 
call  OmOM(15) 
call  Q“ON(lP5 

TYPE  908 

ACCEPT  909,  ADNA(l),  ADNA(2) 


COmTINUE 

call  0SCL9(IE9P) 
call  OSPUMflEPP) 
call  OSSTOPflERP) 
call  QSSECMIEPR5 

CALL  QSIC(IEPR) 

CALL  OM0^(^3,A0^A(n,3,  1220# '16) 


I 


IF  ( SPMS»i(e)  ) 60  TO  7 
TYPE  P32 

ACCEPT  901,  ICHTRL 

IP  { ICNTPL  ,LT.  I ,09,  ICNT9L  ,6T,  5 ) GO  TO  I 
60  TO  ( 2,  3,  U,  5,  6 ),  ICNT9L 


continue 

TMpP  Rl3 

ACCEPT  901,  ICTW 


Tvp£  ^\u 
accept  <)0l,  IR»h 
TYPE  915 
ACCEPT  OOJ,  ICH 
TYPE  916 

ACCEPT  901,  T<3DR 
GO  TO  7 

C0^TTNUE 

type  950 

accept  923,  KRL  * 

GO  TO  7 

ti  COMTI'JUE  ' 

TYPE  917 
ACCEPT  901,  ISH 
TYPE  918 
ACCEPT  901,  IG-^ 

TYPE.  919 

ACCEPT  901,  IGOB 
TYPE  920 

ACCEPT  901,  lATSw 
GO  TO  7 

5 CONTINUE 
GO  TO  7 

6 continue 
type  905 
ACCEPT  923,  JO 
TYPE  910 

ACCEPT  901,  ITAPE 
TYPE  931 
ACCEPT  901 , lOA 
TYPE  907 
ACCEPT  901,  N5 

7 continue 

T = jn/3600.0 

C TNiTTiLiZE  T9AM5TI0N  HAT9ICS 

T9an51.(3,33  a FXP(  -ooo.o*T  5 
TPA.NStfa»")  s EXP(  -3600, 0*T  ) 
TPanSG(3,31  a ExP(  -900. 0*T  ) 
TPANSG(U,U)  a EXP(  -1800, 0*T  ) 

C XYXXYX  90*p9  clear 
ICOUNTrO  , 0 
if  s 5.0 

C INIT4LI7E. stacks  «, 

NOOELA  s 0 
Pf'OLO  0 0,0 

00  75  I n 1,  S 
OAV(I)  a O.C 
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75  COv'TI^Ufc 

CiLL  Q-P04S  ( DAV,  0»  B,  IFRR  ) 
call  OSTDA 

C initialize,  constant  tLEMENTS  OF  ALL  MATRICS 
DO  77  1 = 1,  U 
XI  c 0.0 

xscn  = 0,0 

XM(1)  s 0,0 

xLcn  = 0.0 
KG(n  = 0.0 
xKLtn  = ft.o 
XKGfl  5 =0.0 
DO  77  JI  s l,a 
PL{I,Jn  = 0.0 
»G(i,jn  B 0.0 
77  COsTIMJE 


CAi  L GSIC  HERR) 
A T X'  5 0 . 0 
TUaO.O 


call  OaSLL(  0,  SO,  IFOR  ) 
8 CALL  QPSLLt  0,  SO,  lERR  ) 
1^  (.NOT.  SOI  GO  TO  fl 

CALL  GSOP(  lERR  ) 

GO  TO  10 


c ***  start  of  program  loop 
R CG‘''TINuE 

CAIl  GRSI.LC  0,  SO,  lERR  ) 
IF  ( SEMSi^CSI  I GO  TO  10 
IP  f .NOT,  SO  ) GO  TO  9 

10  continue 


IF  ( SENS'-  ( n ) GO  TO  500 
C ABORT  PUN 

IF  { ( moDF  ,EQ.  2 I .and.  ( X ,LT.  0,16687  ) ) CO  TO  500 
IF  CI0.GT.N5)  GO  TO  500 


1 1 


I* 

'J 


C 


IF  ( .NOT.  SFNSW(2J  ) GO  TO  11 
type  ctt)r\ 

ACCEPT  901,  NODE 

ccntinue 

‘■tine  s .false. 

IP  ( NODPLA  .EC.  NODE  ) GO  TO  12 
pti«e  = .TRUE. 

MOOELA  s “OOE 
GOTO  RSTART  if 

LAtSw  B 1 

nablGS  a ^FiLSE, 

GSCDRT  B .false. 

GSSw  ■ a 
HDGOB  B 0,0 
continue 


C INPUT  CONve»S!QN 

call  5PRADPC  AOV,  0,  IB,  lERR  ) 

IF  ( MODE  .me.  a ) (SO  to  13 

C ILS  analog  values  t RADIANS#  KNOTS#  N«  ) 

y e 20.  aAOv/M  ) 

PSl  a 3,iiR0fe5B5*ADV(5) 

Y a AOV(2) 

OM  s O.OBRBl 317*AOV(3) 

Z s ADV(35/3.035 
T*^  c ! . 7a532R3*AOV(R) 

GGA^-  = C.  17u53PR25*aov(105 
G*^  s 0.02aab7233*AOV(in 
TDM  z 1 ,7u532R3*A0vn?) 

YD  = -IOOO.C*AOVn3) 

YD  a - 1 000.0  *40Vna) 

QNP  a -0. 717*0. 06R«l3I7*A0vn5^ 

GNF  = -0. 1357*0, 02aab7233*ADV(16) 
range  s SQRT(  fy*1.5)**2  + Y**2  ) 

GO  TO  \U 

13  CCMINUE 

C TACAN  analog  values  ( RADIANS,  KNOTS#  NM  5 

y a 200 , 0* ADV  1 1 ) 

V a 20.0*adv(2I 

QM  s 0,«e>5a?l  13ii*AOV(3) 

PSI  a 3,aR065P5i»ADV(S)  . HDGOB 
QNF  = -O.FbSapl  13Ai*AOVC15) 

RHQ  s Ph 

Rw  a SQFTf  y**2  + v**a  ) 
range  s pm 

C MUST  QUANTIZE  O^E  RANGE 
itt  continue 

MH  S 3, aR065°5* ADV n 7 ) 

GAM  = -3.«R0bS<^5*A0V(R5 

PHI  8 1 .7ii532P25*ADV(6) 

UO  a 1000.0*AOV(7) 

GO  TO  ( 100,  200,  UOO  ),  MODE 
C HDG  ILS  TACAN 

C GOTO  MODE  SWTTCHfMOOEI 

C “AN.HDG.COMPf  PSIEMH  ) 

100  CONTINUE 

A EDI  a hh  . PSI 

PMIC  a AEDl,  UO  ) 

IT  a 0 
call  I.A^FIn 

VPTR  s -0 .57?R577R5*pmIC 

IF  ( IDA  ,FQ.  1 I VPTR  a -0 , 572R57795*  ( PHIC  * PHI  ) 

call  QMjDAPf  VPTP,  5,  IFRH  ) 

on  TO  R 
GOTO  mAITlOOP 
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C 


I 


C ILS  «00E 

200  continue 

IF  ( .NOT.  FTI**E  ) GO  TO  201 
RM  B 5.0 

RA  B RH 
AY  a 0.1 
CALL  LATIC 
LC  B .01 

PL(l»n  a 0. 000006 

PL(?,2)  * 0.000006 
PLf3/3)  a O.OOOOOOa 
PL(U,^i)  a O.U 

0LD2  a 1.0  - F.yP(  -3600. 0*T  ) 

QU3)  a 0,0n0000l36*(  1.0  - EXP  ( - 1 800 , 0*T  ) ) 

QL(li)  s 5.8232805E03*(  1.0  - EXP(-«31  1 ,377bT)  ) 

C THE  following  IS  FOR  GS  ALT,  NOLO  MODE 

AH  s Z 
TFIP  b TM 
HE15  a 2 

C ILS.CO'^mdn 

201  CONTINUE 

IF  ( IT  .GT.  0 5 GO  TO  202 
X<L(1)  a QM 

XKL(2)  a -UO*SIN(  PSI  - QM  J/RH 
(503  a XKLC2) 

2C2  continue 

IP  ( ABSCQWI  .LT.  0.062831853  ) RA  a VHC*SIN(  OH  - GAMH  )/QOB 
A y s 0 , c 

IF  (Ta.LT.aOO.O)  AYbO. UEXP(-T«/8,0) 

RHAepm 

DE  = OH  - T*VNG*C0S (GAmw) 

PD  3 PA  - PE 

PH  s OP  * av*lInIT(  20.0*JO,  RP  ) 

IF  f PH  ,lT.  5,0  ) RH  s 5,0 

IF  ( GSCORT  ) RH  s PE  ♦ 0,l*(  SH  ♦ 1.5  - RE  ) 

IF  ( IRH  ,EO,  1 ) RH  8 range 

RHI  8 RM 
RH2  = 1,0 
SDH  a 0 M 

call  LATCOMc  phi,  RH2,  SOM  J 

IF  ( ir.DS  ,E0.  1 ) OOfi  a .UO*SIN{  GAM  . QNF  )/RAN6E 
»<V5S,0/(8,0*S72,Rfe*AgS(QHn 

PHICT  a ( 3«7,it*KY*OH  ♦ 0,8333*008  ) * , 0 1 7«532R25*  1 . 25«5 . 0 

8 O'*  - ONE 
DHF  E DH  - QNF 
OCE  a OOP  « vd/banCE 
REP  B PH  - Range 

CO  TO  ( 210,  215,  220  ),  LAT8W 
'■  HH  capt  track 
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hold 

continue 

1C  a e e 1 

AEDl  B WM  . PSI 

PMic  s aeoi,  uo  ) 

LOC.BE4“.SEnSO».ETC 

IE  f SE-^SWCU)  ) r,0  TO  215 
PL  s 0.0 

IF  ( .LE.  0.055650536  ) GO  TO  211 

ATv<  c 0.0 
CT/.  s 0.0 
IT  t 0 
c 5.0 
r.n  10  225 
COMTI-jUE 
»L  = 0.00000001 
IF  ( IT  .Ef3.  30  ) GO  TO  212 
IT  s IT  ♦ 1 
AT*  C a.O 
CTW  s o.n 
GO  TO  225 
CO^’T:^UE 
Rt.  S 0.0 no •■'0  0 1 

I*"  C ( (OH. gt. 10.01  .AMO.  (APS(OH)  ,GT,0.0ai867Pl  ) .OP, 
f ( (OH. lF. 10.05  .AMD,  (APS(0H5 ,GT, (0,0ai6679+0, 001396263* 
$ (lO.O-OH) ) 1 1 5 GO  to  225 
IE  ( O.C06«P7a  ,GT,  ABS(QH5  5 GO  TO  213 


IF  t ARS(pwlCL)  ,LT.  ( 2,0/57,3  ♦ ABS(2,0*OH)  ) ) GO  TO  225 
XFEP  TO  CAPTURE 
COVTIMjE 
IT  e 30 

PL  e O.OOOOOOOi 
LATSW  s 2 

nablgs  s .true. 

LC«  = T'JPE.CO»'-P 
C 0“lT  I 

» 1. 3 0 . 0 0 0 0 0 0 1 
I C S 0.02 
FHIC  3 PhICL 
LOC .CAP. TO. TRACK 

IF  ( ( iPH(OH)  ,GT,  0.0^6PP7U  5 .AMD, 

% { ( ARS (UH5 ,GT .0 .01 0^75  .OR,  ( ABS (G ABH 5 ,6T  , 0 , 3«9066 5 5 ) GO  TO  225 

rOMT  iMijE 

RL  s O.OOOOni  . 

LATS.,  S T? 

MOUJC  s PMIC  - PHICT 


LTcack ,C0“P 
CO'^'T  Im;E 

Taa’«*l  ,0 
LC  b 0.015 

*V  c G.«R?5*AV 
PMIC  a k'P'^IC  PhJCT 
HPwlC  = O.RR5*HP^IC 

I*"  f P-  ,LE.  5.0  5 PHIC  a Rh*PHIC/5,0 


c 


CT«  e 0,0 


XM(aj 

xR(n 

X*?(2) 

XR(5) 

xRta) 

XI  S 


8 

8 

s 

a 

a 

a 

a 

XI 


XM(1  ) 

X*1(2) 

XM{3) 

XM(<4) 

XRfl  ^ 
X»(2) 
XB(3) 
XR  (U) 
♦ 1,0 


♦ QME 

♦ QH£ 

♦ QWF 

♦ (PHIC-PNIJ 

♦ 

+ (QHE)**2 

♦ (QnF)i**2 

♦ (PHlC-PHl ) 8*2 


225 


300 


CONTI^-UE 

call  latfi>; 

GOTO  8AITL00P 


GS,  INIT 

IF  f ( (GM)  ,gT,'  0,00P7738P0  ) .OR,  ( .MOT,  wablGS  ) ) 
F GO  TO  350 

IF  ( GSSi»;  ,NE.  « ) GO  TO  301 
rOMTT\-j: 

s 1 
a 0 
GM 

?/(  GSA  - GH  ) 

8 GSA  8 TM 


IC 


IC 


GS3- 
Gs:  ■ 

GH  a 
SH  8 

ATGSN 

GOH  a -0.7*UO*SIN(ATGSN)/SH 
GOF  » GOH 
VHTM  = UO 
UFl  a UO 
ATS-  a fi.O 
UF?  a 0,0 
TFJ5  a TM 
TF1  a TM 
yK  maTHICS 

call  KALCLRI  XK6,  PG  ) 
XKG(l)  = f'-“ 

XKGC25  a GOH 
P MATRICS 


PGfl  , 

15 

a 0,P03il0e4 

PG(2, 

2) 

a 112.80 

PGn, 

3) 

a ft,003O0eu 

PG(P, 

ti) 

a 1160000,0 

00(2) 

8 

1,0  - EXP(  -3600. 0*T  ) 

00(2) 

8 

20.0*CG(2) 

0G(5) 

a 

0,00815575*(  1,0  - EXP(  - 

0G(3) 

a 

0.05*OG(3) 

0G(3) 

8 

7.5*0G(3) 

OG(u) 

a 

1 ,l6a6569E07*(  1,0  - EXP( 

QG(P) 

a 

20.0*OG(«) 

f.  GS,C''“MnM 
301  COHTIMUE 

A15  a EyP(  -Jo  ) 

IF  C OiCOBT  ) A15  a EXP(  -JO/15, 0 ) 
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TFiS  a M5*(  TFIS  « TH  ) 4 T” 

TF15C  a TM  - tF!5 

iEOl  8 ExO(  -0.015915U«»U*J0  5 

UPl  * AED1*(  UPl  - UO  ) ♦ UO 

UP\C  a UO  - UPl 

AEDt  B Ex»(  -0 , ) 

UP?  ■ AEDl*(  UP?  - UPIC  ) ♦ UPlC 
SMO  a 

SA  s 7/1  GSA  - GH  ) 

SE  a SH  . T*VHTN*COS ( ATGSN) 

5H  a O.QtSE  ♦ 0,1*SA 

SHI  s SQRT(  X**2  4 Z**2  ) 

IP  ( ISH  .EO.  1 5 SH  a SHI 

IP  ( O.O  ,GT.  SH  ) SH  a 0.0 
AEDl  a EXt’C  -JO  ) 

TPl  s AED1<((  TPl  - TH  ) 4 TM 
Trie  a TM  . TPl 
TDM  = TPlC 

ATC.SE  8 iTGS'''  4 JO*TOM 

ATSF  a SH  - SHO  4 T4VHTN4COS CATGSE) 

ATSW  a ATS>«  - 0.0064(.LATSw*«TSE/T 
IP  C IATSh  .EQ.  I ) ATSH  a 0,0 
WSM  c ATS'4 
VHT^  a IJO  4 ATSw 

PK  3 -5ti00,P4VHTN*T0M/SH 
OPH  a 1.0 
ZK  a r,K 

IP  ( GSIT  ,NE,  0 ) 

$.  CALL  KALfllC  T<  IK>  TRANSG,  0G»  KKG,  PG,  KG,  RG(GSSW),  PK,  OPH) 
OS  IT  3 1 
GH  a XkGM  ) 

RDM  a X<Gf?) 

IP  ( IGH  .EO.  1 ) GH  a GM 

IP  ( IGOH  .EG.  1 ) GDH  a -(  GSA  4 TM  )*UO/SHI 

AtOl  a EVP(  -0.5*JO  I 

OOP  a AEOl*(  GPP  - GDH  ) 4 GDH 

ATr,3M  - un  4 ATSW  ) 

'OCA  a 10,5<?«35*SH*GH<>  ( 1.0  - VHTN/360.0  ) 

TOC4  a TDCA  4 I . S 4 0 . 5 72  95  * 1 . 686 1 *SH  *GDH/ VMTN 
TOCA  a TOCA  4 0 . 5 * GDP *SH/ VHT H 
TOCA  a TOCA  - TP15C 

GO  tq  ( SIO,  515,  520,  350  ),  GSSW 
C PPECAP  CAP  TBK  IDLE 

C GS , POEC AP .COMO 

310  COMTInuE 
C GS.P. TO.C A» 

IP  ( SESiS^CS)  ) GO  TO  311 

IP  ( ( GMJ  .gt.  0.002850705  ) GO  TO  350 

311  CC''TIVjE 

GSSr  a ? 
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GSCOPT  s ,TPUE 
TC  B TM 


C GS, CAP. COMP 

315  CO^TIMUE 

RPM  s SH*GH/(  1,0  • COS(ATGSN)  ) 

PP\  a SIGK(  PPM,  AT6SN  ) 

TDC  a -VMTM/CSfSOO.OAPPMl 
TC  B TC  + JO*TOC 

HPTR  a «,0*(  TC  - TM  ) - 0,02aUF2 
C GS.C.TO.TRK 

IF  ( (GH).GT,  0.001628973  ) GO  TO  325 
GSS-i  a 3 

TOCAT  a HPTP  - TOCA 

C RS.TSACK.COMp 
320  CO'^iTlNliE 

HPTP  a TOCA  ♦ TOCAT 
TOCAT  X 0,985*TOCAT 

325  C0^TI^iljE 

C OUTPUT  DA  values 

DAV  (21s-.2A6a7«0O7*(GAMH«GAM) 

0AV(3)3.,2Bfe07»897*0H 

OAvfSla-l U.3?39PP«9*(QH«QnF) 

IF  (SE^JS^(7))  0AV(5)a.ia,3239«a89*QM 
0Av(7)a-0.5*'5OE 

C OUTPUT  P/A  values 

DAvm  a 0.05*f  PH  . range  ) 

IF  ( SFNS*(6)  ) DAVtn  a 0,05*(  SH  • SHI  ) 
pAv(?)  a -0.005*(^H 

IF  { SF>?i».(6)  ) OAV(2)  a .0.005*ATSW 
DAvf3)  a ( QM  - QM  1/0,0681317 
IF  ( SEMSW(61  1 0AV(31  a -5 . 729577955* AT6SN 
PAv(U)  a -1  <J , 3?3q<i5«  ( fJH  . qmF  ) 

IF  ( SENSx.(61  1 OAVCtt)  a .UO , 8709886*  ( SH  • GM  ) 

D4v(5)  a COB  • VO/BANGE 

IF  ( SEMS>*(61  1 OAVfS)  a GOH  - UO*GGAM/SMl 
0AV(6)  a -C.57?9S7795*PHIC 

IF  ( IDA  ,Ef3.  1 1 0AV(6)  a -0 ,572957795* ( PHIC  - PHI  ) 
PAv(AiB-n,0572957795*HPTP 

00  mo  1 a 1,  A 

OAV(I)  a LIMIT!  0,99999,  OAV(I)  ) 

300  continue 

call  0>.3PAP(PAv,0,e,IEPP) 

ICOUNTalCOUMT+l .0 

IF  ( ITAPE  .EO.  1 1 CALL  QMON ( 1 6 , RANGE , DUMMY ) 
lUBlO^l 

CALL  QSTOA 
GO  TO  9 
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C ENiO  OF  ILS  Pwnr,P4M  LOOP 

C 6S  IDLE  STATE 
3S0  CO'JTI'^tiE 

IF  ( SFNJSo.(5^  .AND.  NiABLGS  .AND,  GSSW  ,EQ,  « ) GO  TO  300 
AcOl  s EXP(  -JO  ) 

TFIP  s 4E01«(  TFIP  - TM  ) ♦ TM 
TFlPC  s TM  - TFjP 
AEOi  = £XP(  -jn/15,0  ) 

HFis  3 AED1*C  ^^FIS  - Z 1 ♦ Z 
HFlSC  s Z - HF15 

MPTP  r 2,0*(  AW  . z 5 . TFIPC  - 2,0*HFl5C  - KHD*0,2*GGAM 
GO  TO  325 


«00  CQ’jTImhE 
C T4C  ,IMT 

IF  ( .NOT.  FtIME  ) GO  TO  «01 
CALL  LATK 
P S 1 M 0 K-  s G A M H 

pi.n.n  = a 0.73 
PL(2,21  s 1000000,0 
Pin.3)  e 0.0*,25 
OLfa#a)  3 U70000000.0 

OLO?  s a7000O00,O*(  1.0  - EyP(  -3fe0,0*T  ) ) 

OL(3)  s 3.0*0,000n5a*(  i,0  - EXP(  -1600. 0*T  ) ) 
CL(a)  s U7iT00000000.0*(  1,0  - EXP(  -3600,0*7  ) ) 
LC  = 0.001 
RL  s 500.0 

TOKTPP  s 15.0/(15.0*57,29577951 
GV  = 5.0/57.2957795 
GVD  8 0,12/57,2957795 
C HYPPIO  ONLY 

C 7iC  ,CC^'‘'.OK 
<i01  COnTI'H'E 

IF  f IT  .GT.  0 1 GO  TO  «02 
XKL  ( 11  = Gw*Rm 
YKL(21  s -iI0*SIN(  PSI  1 
/2u  3 y^uai 

K?IL  3 GAMW 
a02  COnTIvL'E 

P^*l  3 1,0 
PH2  c Rw 
S C “ ■ Q w 

C*LL  lATCGmc  BMl,  RW2,  SQM  ) 

IF  ( IQO0  .Fq,  1 ) noe  a -UO*SIM(  GAM  ) 

GP  s 1.0 

IF  r RW  ,gT.  50.0  1 CP  B 50,0/PH 
OVSTR  s 10.5*110/500,0 
OF  j E/P(  -IG/30,0  1 
*2,  a CF*(  Y?L  - tlGB  ) ♦ QDB 
*Sll  s CP*f  /SIL  - GAmh  1 ♦ GAMH 
vOt  b x?L  - vwr,*(  GAMW  • XSIL  1 
A E 0 I 3 * K L ( 1 1 

IF  { IGH  .£0,  1 ) AEDl  a Oh*RH 


o n 


GO  TO  ( 410,  415,  420,  425  ),  UATSW 

C TftCMw.CO^'P 

410  CO^TI^)l'E 

AEOl  S HH  - PSI 

PHTC  X AEOl,  tjO  ) 

C 7iCMH.TD.CAP 

IF  ( SE^’®1''(43  3 cr  fn  iiii 

IP  ( ( PH^ABSCO-l  ,GT.  10,0  ) ,ANO,  ( IT  ,LT,  1 ) ) CO  TO  «30 
IT  3 IT  + \ 

IP  ( IT  ,LT.  30  ) GO  TO  430 
ADJP^^L  = 0.35  ♦ LIMIT!  0,15,  0,3*(  RH-70,0  5/80,0  5 
IF  ( ( C P-ilCL^PHlCT  ,LE,  0,0  5 .OR,  ( ABS(  PHICT  ) ,LE. 

$ A9S(  PMICLAAOJPHL  5 5 5 .OR, 

$ ( f A9S(  OH  ) .LE.  0,01746)  .and, 

S ( ABS(  phtct  5 ,GT,  0,01746  ) ) ) GO  TO  430 

411  COvTlNijE 

IT  5 30 
LATSh  X 2 

C TAC4PT1JPF,C0HP 
U15  CC"•TI^uE 

»L  s SOO.O 
PSINOW  a PSI 

IF  ( ( A3S(  PHTCL  5 ,LE,  A8S!  PWICT  ) ) .AMD., 
f ( QHtPMlCT  ,lT,  0,0  5 ) GO  TO  416 
PMIC  3 PHICT 
ITEST  s ,TPijE, 

74CAP.TO.Tk< 

IF  f ABS(  OH  ) ,GT,  TPKTRP  ) GO  TO  430 
LA7SW  e 3 
GO  TC  420 

Chic  = pHicL 

c msT  X .fal'^e, 

GO  TO  430 
r T4C . ^piCK . :oHp 

4?0  continue 

PHIC  B PHiCT 

PL  3 LIMIT!  250'', 0,  25,0*RH  ) 

«L  s KPL*PL 

PSINQW  X O.ROOSU*!  PSINOH  - PSI  5 ♦ PSI 

e OH  « r;NF 
r.Hf  a r,H  • gnf 

OD~  s OOR  - yD/bangE 

s PH  . PANGE 


i VM n 5 

s 

Y-cn 

B 

YM(2) 

4 

ONE 

Y *'  f 3 1 

s 

Y “ ( 3 5 

t 

GMP 

Y H ( a ) 

a 

YM  f a 1 

(PHIC-OHI) 

Yo  f n 

3 

YB(n 

♦ 

(C'*E5**2 

, p f PI 

3 

Y»(P) 

* 

(C-F  5 *♦? 

Y = f 3 1 

- 

YP  (35 

♦ 

(ONE)**? 
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»!?(«)  3 XR(U)  + (PHIC-PHn**2 
« XI  ♦ 1.0 


C TTPX.TO.OVS 

IF  ( »H  ,GT.  OVSTP  3 GO  TO  UlO 
LATSW  * « 

C 0VS.T0.C4P 
«25  CONTINUE 

4E01  ■ WH  - PSI 
PHTC  T XMANHOC  AEOl,  UO  3 
!E  ( PH  .LE,  OVSTP  3 GO  TO  430 
C ***  ^UST  »E-IC 

LATSW  B 2 

PL(1  .13  a ue,73 
PL(?.?3  a 1000000,0 
PU3,55  a 0.0625 
PL(4i,a3  s 470000000,0 
XKLtn  a Q>-'*PW 

X<L(2)  s -!J0*SIN(  PSI  ♦ PSINOW  3 

X2L  a XKLC23 

XKL(33  = 0.0 

XKL(43  s 0.0 

CT  A 3 0,0 

GAMH  e PSI 

XSIL  = PSI 

430  continue 
call  LATFIN 

DA V ( 1 3 a -OH 
OAvi:23  a -0.005*CTW 
XXVX  s latsh 

OAV(33  B 0,1*XXXX 
DAV(ai  3 ( DH  - DM  3 

DAvfS)  B -DOh*o, 572458 
DAv(6)  s -n.S72PS7745*PHlC 

IF  ( IDA  ,ED.  1 3 DAVC63  a .-0 , 572957795*  ( PHIC  - PHI  ) 
00  U31  I * 1 , 5 

DAVfI3  * LIMIT!  0,99999,  OAVCI3  3 

431  CONTINUE 

CAlL  Q^eOAPC  DAV,  0,  8,  lERR  3 

IF  ( I’APE  ,EO.  1 3 CALL  QM0N(  16,  X,  DUMMY  3 

call  OSTDA 
GO  TO  9 

C END  OF  TACAN  PROGRAM  LOOP 

500  continue 

call  0SK(1ERR3 

CALL  OSOLXC153 
call  DMONf2(4,  I 1 n3 
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CftLl.  VPCNiT  (XKL.M.N'f  fcwXKL  ) 
call  (PL,‘^,"J,6HPL  ) 

CALL  VPPMT  C<L,N,^,6Hi<L  ) 

AfOl  s RH  « 0A»;G£ 

TYP£  931,  AEDl 
TYPE  93«»  CTW 

IP  ( MODE  ,EQ.  3 .OR,  GSSW  ,FQ,  « ) GO  TO  501 

call  VPRMT(  YKG,  N,  N,  6M  XKG  ) 

call  PPMT(  PR,  Ki,  N,  6H  P6  ) 

call  VPRN-T(  kg,  M,  6H  KQ  J 

TYPE  935,  atsw 

501  CDniTINUE 


II 


TP  t SENSWtn  5 60  TO  I 

IP  ( LATS>^  ,LT,  3 ) go  to  9993 

Do  9991  IB1,<1 

XM(nsXM(Il/XI 

9991  YRdlsSORTf  (XR(I  )-(XM(I)  )**2)/XI) 

AEOl  s 9297.1?3a6a 

IP  t MODE  .EQ,  3 5 AEDl  s 859,333925 
CO  999?  Isl ,3 

XM(1)  = AEOl*yM(i) 

XPtI)  8 AEDIAXR(I) 

999?  COMTIMIIE 

XM(a)s57,?957795*XM(9) 
yR(0)a57.?997795*X»(9) 
call  VPRmT  (yp,N,N,t>MK  Pm8  J 
call  VPRnT (XM,n,N.6MX  HEAN) 

TYPE  9«0 


9993  continue 

call  QM0N(2^, • 16) 

IP  ( ITAPE  .EG,  0 ) CO  TO  1 
995  call  OmON(21,ADNA(1),1, 'U) 

1000  TVPE  903 

ACCEPT  90U,  ITI,  IT2,  IT3,  ITU,  ITS,  IT6 

TYPE  950 
ACCEPT  901,  A'l 
IP  <vi,GT,n  GO  TO  2000 
IP (N1 .L  T. 1 ) GO  TO  1000 
IP  (ITl ,lT, 1)  GO  TO  I 
call  QMCWtSl . ADNA ( I ) , 1 , il6) 
no  1001  J9*1,nu 
call  0M0Nn7,0(i),D(5«n 

TYPE  9ai,  D(ITl) ,0(TT2),0(lT3),0(lTa),0CIT5),0(lT8) 
IP  (PENSwd))  GO  TO  1000 

loot  continue 

GO  TO  1000 

-,00  CALL  QMON(2UADNAn),  1,  I’ib) 

CO  2001  J9el,N4 

call  QM0N(17, range, dummy) 

type  902,  ICOUNT.FK.SOiJMl  ,80UM3 
call  VP9M(KL,n,N,6HKL  ) 
call  VPPMdKL,^,N,6HXKL  ) 
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CALL  P5*jT(pi  ) 

IF  (sf'iS'xn  n GO  TC  looo 

200!  CDMIMJfc 

GO  TC  1000 


900  FOR‘'4T(  U3H  c 1,  2,  0«  3 FOP  ^^DG,  ILS  OR  TACAN,  RESP,  ) 

901  PORMATflhO) 

902  P0»-AT(/,?P1S.F,/I 

903  FOP-^AThh  ,23htyPF  fe-p  DIGIT  INTEGERS/) 

90U  FCR''AT(*«IP) 

905  FOS-aT(  lOi^  s JO) 

90'S  FOR*^AT(  ?H  X mqoE) 

907  C0R“AT(  e n;5) 

90fl  F0-5P4T(  17H  s file  '^AME)  ' 

909  r09HaT(2At.! 

910  FOR“AT(  A7n  SO,  1,  OR  2 - MO  TAPE,  SF,  OR  FT  DAT,  RESPT.) 

911  FOOmaTCIOh  ICOMNiT  s , 15,  / ) 


91? 

forma  T ( 

7M 

s 

INF) 

913 

F 0 R M A r ( 

BH 

= 

I C T k;  ) 

91  U 

F OSMAT  ( 

7H 

s 

IRH) 

915 

FC=M  at  ( 

7M 

S 

TOM) 

916 

F C 9 ••  A 7 ( 

BH 

S 

1003) 

917 

format  ( 

7M 

s 

ISH) 

918 

FOS>/AT  ( 

71- 

3 

ir-H) 

910 

FORMATS 

8H 

MX 

IGDH) 

9?0 

format  ( 

9H 

s 

I ATSW) 

921 

format  ( 

9H 

s 

IGGAM) 

92?  FDR-^ATC  13^^  * KATSW) 

9?3  eORVATC  FPO.IO) 

9?U  FO^'^ATf  13P  a KTDCT) 

9?5  RD'^'^ATf  13'-  s KTOCC) 

9?fs  POR'MJt  1?^  B KUF?) 

927  P'-!  = --ATC  13h  b KkcTw) 

p T r 1 1 B KF  K ) 

q;ig  P"1:?'-*4T(  1}^  aKRA) 

930  ^-0  = “^AT(  aXRL) 

931  p09M4T(  7h  3 lOA) 

93?  FOP-AT(  u9h  a 1.  p,  3,  a,  OR  5 FOR  L,  LK,  0,  GK , OR  GENERAL) 

933  PC^MiTf  11-iRs  ERROR  a , F l £1 . 8 ) 

93«  FOR^iATf  6hCTw  s , Flu, 8 ) 

955  F09n^AT(  7HATSW  E , Fiu.8  ) 

9U0  FncMarnp*  ,ih  /) 

OUI  format CfeFi 1 
9U?  format  (UEl?.*!) 

350  FCRMATdH  .16HTYPE  1 TO  ACCEPT/) 

FND 

C «!JB  1 

SURRCuTiME  latcOMC  Rmi,  Rh2,  SGM  ) 

LOGICAL  SEMSw 
seal  limit 

pFaL  Jf^.L,  JOU  ,»^mn,kG,k60 
peal  LC 

real  XL,  KQ2 , XQ3 ,KOU 
real  1C  hunt 
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o o o 


r 


ni^ENSlOS'  yKL(tt).  <L(a),  OLffl)» 

$ PG(31»  TR4\SG(U,U),  PG(U,«)»  XKG(a),  K6(a),  QOCa) 

C0**"1CS  X,Ph1,uO.Z.TM,6GAM,  G”,  T0M,XD, 

SPL.  GNF,T,  OL.  T»AKSL»  KQ2,KQ3,KQa, 

IZK,  VO,  V,fJ^*,»w,QOn,RA, 

10'^,CTE,CTiS,ATF  , ATW,Ki.'M,OH,  VHG,RN,PHIC, 

JiPSl  , gam,  game  ,GAKH,OhE,00E,  PER, 

%RANJGF , ICOUM , FK,  KL,  itxLi  PL » OUMMy, 

$ PhICT,  PHICL,  OLC2,  lOH,  ICT»(,  RHO,  LC#  6, 

$ P^n,  PHOLO,  JO,  lOA,  IT 
OL(2)  s 0L02*?,0 

IF  ( IT  ,GT.  25  5 QUf2)  s 0102*0,0005 

ORH  c RH2 
2K  s SQH 

F«  = -G*SINi(PHn*COS(GAMH)/(COS(PHI)*RHn 
IF  ( IT  ,GT.  0 ) 

* CALL  kalFIL(  T,  ZK,  TRAKSL#  QL#  XKL»  PL»  t<L»  RL.  FK,  ORH  J 

OHO  S QH 

OW  r XKLn)/»>'2 
G08sVKL(2I 

IF  C .EG.  1 ) GH  ■ QM 

GAMF  8 GAMH  * T*G*SINfPHI)/(  VMG*COS(PHI)  ) 
iTFsRH-RHO*  T*VWG*COS (GAME) 

CTF.  s RH*(  QMo  - QH  ) - T*VHG*SIN(GAME) 

CTE  = i.Imik  0.0012,  CTE  ) 

CT-  e CTa  ♦ LC*CTE/T 

IF  r ICT>^  .EG.  1 ) CTw  B 0,0 

A T c 0 . 0 

whssCPT(ATw**2+CTW**?) 
rr.=  ATAk  fCTi»./ATi‘) 

SIGAs-1.0 

TF  (CTa.GT.O.O)  SIGAs*1.0 

IF  (at/.LT.O.O)  0HaSIGA*(3,lil5R2b5«-AfJS(0H)) 

C*H  s *H*COS(  O'H  - PSI  ) 

S-H  Z *’H*SIV(  CM  - PSI  ) 

VHG  S ,s;5PT(  S>!H**2  + ( UO  ♦ CWH  )**2  ) 
s 4,  ataN(  uo  t CMH  ) ) 

-'M  3 PH*4fcS(GH) 

AFGl  s VMG*VHG*(  1,0  - COS(GAMH)  ) 

A£01  z -,STG‘'(  AEOl,  GAMH  } 

PM’CL  = ATAv(  4ED1/(  R»>:*G  ) ) 

IF  (SEf'^S^Can  PHlCLB-ATAN(RH*OOB**2/(G*QH*(l,0*COS(GAMM))n 
PETUP*-' 

E NO 

S^I800UTI^E  KALFIL(  T,  ZK,  TRANS,  Q,  KK,  P,  K,  R,  FK,  H ) 

«#*******«****  KALMAN  filter  subroutine  **#•**♦*#***•*#*** 

peal  < 

OI•■•E^SInN  TPAN9(a,«)  ,PP(U,u)  ,K  (a)  ,0UM(R,«),Q(«)  , 

1 V<  (ti)  , XXP  (ii)  ,P(i*  ,U)  ,COUM  (41) 


! 

t 


f 
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d 


f 

f 

i 


C«*ir**«*«***«**«****  COMPUTE  PpBTRiMS*P*TRANST  + 0 

C 

C 

C CCMPtiTE  (O'JM)  s(TPAMSHP) 

C 

ouMH , n*p(i  • n + T*P(?,  t i 
OUMd  ,25rP(l  ,p^*T*P(2,?) 

DUMM  ,3)=Pn  ,3UT*P(2,3) 

OUMfl  ,(i)sP(l  ,<i)*T*P(?,U) 

ouMC2,n=p(?d)  + T*pfu,n 

DU>'.(?,?5sP(2.2)+T*PfU,2^ 

niJM(?>.-S5sP(?,3)-*.T*P(ii,35 

DU“f  3.  1 IsTPAlS  (3  , 3UP(3,  I } 
OUM(3.?)sTPAs.S(3,3)*P(3,2) 
DUm(3,3)=T«A-^iC(3.3)*P(3,3) 

DU“f3,u)  = T»A'^Sf3,3)*P(3,U) 

'>UM(U,  1 ) = TP  AMS  (Zi,  a)  *P(ii,  1) 

OU‘'(^J,?)3T6AMS(4,in*P(ij,2) 

DUMCa,3)eTPA‘:S(‘»,41*P(i<,3) 

DUM(a,45sTPAMS(4,4)*P(4,a) 

C 

C COMPUTE  (PP)s(DuM)  (TRA^S)T4.C) 

C 

pp(t , n=ouM(  1 , n+T*DUMn  ,2  5 
P»(?,  nsOU'^(?,  n + T*OUM(2,2  5 

pp(3, 1 )BruMn»  n*T*ouMf3,2) 

POT4,l)=CUMd,n+T*DUM(ij,2) 

,?3  + T*ouMn  ,4) 

PP(Pr2)suUMC2,2)+T*OUM(2,4)+QC2) 

PPf3,?5  50U-''(3,?)*T*OUM(3»4) 
PP(4,?5rr)iJM(u,5)4.T*OUM{u»4) 

PP(1  ,?5cOMMn  ,i5*TPAN.‘St3»3) 
PO(?,3^sCU‘^(?,3)*TPA^S(3»3) 
P®C3,35'=OUMr4.35*T«AKS(3»3)'*-0(3) 
PPf4,3)=DUM(^J,35*TPA^S(3»3) 

PP  (1  . 4 5 nOtr-  n»‘i)*TRAMS(4,4) 
pp(2,4';cOUM(2, 4j5*TPAUS(4,4) 
PP(3,4)s0UM(3,<'O*TPAUS(4,4) 
PP(4,45er:'jM('4.u5*TPANS(4,45+Q(4) 

C 

C*«****************  COMPUTE  KaPP<tHT*{l/H*PP*HT) 

C 

C COMPUTE  ( OUM  5 3(PP)*(H)T 

C 

CO  30  lej,4 

30  COUMfl)  s PP(I,1T  + W*PP(I,3) 

C 

C COMPUTE  (H)(  (PP)(H5T  ) 

C 

SOijMi  M CDUHfn  ♦ H*C0UM(3)  f R 

c 

K n 5sCOUM(l 5 /SOUHl 
K (?5=CDUM(25/SDUM1 
K(3)sCDUM'’3)/SOUMl 
K f4)sCDlJM(45/3CUMl 
C 
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r»  o o o r»  o c~*  r> 


i 


»*A*************  CO^f’UTE  P»PP-K*H*PP 

DO  aO  I=l,u 
00  an  j = I , a 

«o  ?n»j)  B pp(i,j)  - K(n*(  pp(i,j  ) 

«*«*««*«***«****'*  ' C0^^PUTe  t^Al.«AN  estimates  ********************** 

XP(K)sTRANS(K,K-1  )*X(K*1 ) t F(K-n 

y<p  ( nsyK  ( n +T*  VK  (2  5 
X^f’(i?)aVK(?54T*(VK(a)4FK) 

XKW(51aTSiNS(?,3)*XK(3) 

xKP(u)sTPAKiS(a,u5*XK(a) 

C 

r X(K)SXP(K)  ♦ K(K)*(  Z(K)-H(K)*XP(K)  ) 

C 

c 

0 7(K5-s(K)*xPpO 

C 

50UM3  s ►-*(  ZK  - XKP(3)  ) • XKP(l) 

C 

C XFC'0*K(K)*(?('<5-W(K5*XP(K)J 

C 

xK  ( n=xKp  ( n ♦«  ( n*sou!-'3 

xi<(2)  = vnP(2)4«(?)*S0uw3 

X-<C35=XnP(35*i^C3)*SDUf-5 

X<(a)ryKP(a)4X(U)*SDU‘'3 

PETUPvi 

EMD 

C SU=3 


♦ H*PP(3»J)  ) 


SU^POiiTlVfe'  LATFIN 
MEAL  L.C 

=^£aL  -<1..  <^;?,K;3,'<na 
s-EAl.  ICO'ifvT 

Pf‘L.  JO,  lI^-TT,  LC,  pi,  AEOl 

r-I-Es5I0‘.  toavjFi.  ca,u5 , PL(a,a),  XKL(a),  KL(«)»  QLC«5» 
» ><r.(3),  7PAMSGfu,«),  PG(a,a),  xkg(U5,  KG(a),  0G(a) 

CO-'-Cv  x,PhI,'J'’,z,T^',GGAM,  gw,  T0w,XD, 

»p*.,  ^.np,T,  OL,  TSAmSL,  K02,K03,KQa, 

' 7<  .>t  , '■M,  Pa.ona  , KA  , 

’-.C7E,C**,ate,atw,wh,ch,Vhg,Rn,PNIC, 

*-'5  * . ' A “,r-A“F  ,OAVk-,QhE,onE,REW, 

* A'Of.lc  VT,  FK,  KL,  XKL,  PL,  DUMMY, 

-IC',  P-ICL,  0102,  IQH,  ICTw,  RHQ,  LC*  G, 

, P-CLO,  JO,  IDA,  IT 
c j-jC  . P-CLD 
a * . .'•rs-b*  Jr 

f * Ll-ITC  AEOl,  PHII  ) 

- .'•■!’(  0.53*  OMIC  ) 

• p-ic 
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SU‘'»Ct.iT!NF  LiT!C 
PEiL  LC 

icnu^T 

f^EAL  J<^.L,  JOa  ,kwh,kG,KRO 
EEaL  KL.  k 02  , <03  , go 

OI“t''S!C>^'  T=’4NSL(o,u5.  pL{M,0),  xKl(U),  KLC^i.  QL(0)» 
S RG(35,  TRA^iSr,  (a,  0 ) , PG(0,o),  XK6(0),  KG(«),  QG(«) 
CO‘-!MO^  X.PHT  ,ljr),Z,TH,GGA'^,  G'',  TDM,XD, 

$RL,  OMF,T.  OL,  TRAMSL,  KQ2 , KC3 , KQO , 

1 Z<  , VO  , V , 0^. , aw  , rjDR  , ra  , 

1Q)--,CTP,CTw,ATE,AT‘^,wH,nw,VHG,BK.,PHIC/ 

«PSI.GA>^,r,AWE,GAMw,DHt,OOE,REP, 

!«Af..Of , rCCU*'T,  FK,  kl.,  XkL,  PL,  DUMMY, 

? PhICT,  PwTCl,  old?,  TGH,  ICTw,  PmO,  LC#  G, 

J pwn,  pwolD,  jo,  !DA,  it 
call  kALCLPf  XKL#  PL  ) 

PL  = 0.0 
IT  a 0 
QW  s GM 
C T a 0.0 
VHG  = L'O 
GAWW  B P§I 

PwqlO  k Pwi 
C XXX  P'^Il.AG  a 0.0 
P£  TURN 
END 

C SUflS 

S'JfiPOUTINE  !<ALCLR(  XK,  P ) 
dimension  XK(4) # P(4#ai 
001  I = 1 , a 
XK(I)  a 0.0 
CO  1 J * \ ,(i 
1 P(l#j)  = 0.0 

PE-‘JPN 

1 END 

C 

FUNCTION  LI-TTI  L#  VAL  I 
REA^  L,  LI'IIT 
limit  = V A I. 

’ IF  ( a&S(val)  .GT,  L ) LIMIT  8 SI6N(  L.  VAL  ) 


■i 


ri^ENSIP'^  A (u,  u)  , TTITLE  f 3) 

TYOE  101 , ITlTLEd  5 , 1TITLE(2)  , ITITLE(3) 
PO  95  Ial,U 

95  TYPE  100,A(T,n,A(l,2),A(I,3),*(I,«) 

100  POp^-ATriy,  (uf  la.sn 

101  fORMATM  Y,/,5X,3A2,  ) 

RETURN 

E^0 

: SUR9 

SURROUTl^iE  VPRNTCA  ,NRA,wCA,  ITITLE) 
OI^EMSION  A f ill  , ITTTLE  f 31 
TYPE  10)  ,lTlTLEni,ITlTLE£2),lTlTLEC3) 
TYPE  100,Ani,A(?l,A(31,A(Ul 

100  RORKATCIV,  (U£lii.511 

101  RC9M4TC1X,/,5x,3A2,1 
RETURN 

END 


SRIut » 1 ii  ,QmOA< 
5E1LE  , 19  .LIMKN 
50UT , 1 5, TKDROL 
SLOAD 


APPENDIX  D 


fortran  program  listing  (scaled) 


ft 


!hl 


THIS  APPENDIX  CO\TiIVS  THE  PiCEP  100  HYPPIO  PROGRAM  LISTING, 

THIS  MYBRIO  PROGRAM  4 S COOED  IN  FORTRAN  IV,  SCALED  FRACTION, 

THE  VARTAHLES  for  Th£  PROGRAM  ARE  DEFINED  IN  APPENDIX  B,  THE  FLOW 
charts  for  The  program  are  illustrated  IN  APPENDIX  A, 


ow, 

“C,1E 

eN,0«JTAA,l6,l 

ft.  .FTPTR,  lii 

tR,7COOO,2O0Oa,U0706 
aG , 1 OOC 

C main  program,  SFOFOP 

C 

C 1*  * * tI  * 1 

c 

c dfdc  scaled  fraction  hybrid  program 


C MODE  * 1,  2,  OR  3 FOR  HDG,  ILS,  OR  TACAN,  HESP, 

C 

c VPTR  S -PHIC 


C sense  SwITChS 

1 

a 

aborts  run 

c 

2 

z 

70  change  mode 

c 

3 

c 

RIJN  FREE,  time  INTERVAL  NOT  FIXED 

c 

ii 

B 

FORCE  EARLY  CAPTURE 

mm 

LAT,  AXIS 

w 

5 

X 

FORCE  EARLY  CAPTURE 

m m 

G/S 

F* 

S„ 

6 

a 

C 

7 

8 

c 

r 

8 

c 

SIMULATION  control. 

ACCEPT  DATA 

r 

ILS 

TACAN 

L 

C DAC 

0 

S 

RH  ERROR,  10  NM 

a 

RH  ERROR,  10  N 

C 

1 

s 

CTW,  100  KNOTS 

0 

CTW,  100  KNOTS 

c 

2 

s 

ATSW,  100  KNOTS 

8 

LATSW 

* 

3 

s 

QH  ERROR 

■ 

OH  ERROR 

c 

u 

8 

8 

• QOB 

c 

5 

c 

VPTR 

■ 

VPTR 

c 

6 

B 

GH  error 

■ 

c 

7 

8 

MPTR 

B 

w 

C xxy  NOTE  KALFIL  1 AND 

2 

ARE  NOT  scaled  fraction 

C 

scaled  fraction  LOKdfrOl 

DIMENSION  ADNA(?) 

DIMENSION  PL(IH),  OLCR),  XKL(R),  TRLAT(«),  CDUM(a),  PGS(lfc), 

' TGS(R),  V^GSIR),  TRGSCRJ,  CDUMG(«),  RG(ai 
real  SOUM,  SDUmG,  FK,  ZK,  BL 

scaled  fraction  SAPS,SSRRT,SSIGN,  SINX,  COSX,  ATAN8,SL1M1T,XMANMD 
scaled  fraction  A0V(?E.1,  0AV(P1 

SCAtFD  FRACTION  AH,  HH,  TMEi,  WF15,  TMFIC,  WF15C,  RHILS,  QNF, 

« 4 EDI,  GGAm,  gam 

scaled  fraction  tm,  phi,  omep,  psiehh,  psiecr,  qm,  tom,  Gm,  UO,  Z, 

$ X,  Y,  SINDH  I,  COSPHI,  RA,  RE,  RO,  Ay,  Hh,  QHO , OH,  QDR,  GAME , 
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APPENDIX  D 


FORTRAN  PROGRAM  LISTING  (SCALED) 


% CTE,  KCTE,  CT.*.,  pw,  cinH,  SWH,  AEDl,  VWG,  GAMH,  PHICL#  KY» 

5 P^ICT,  PHIC,  HPHIC,  PHII,  PMOLD,  VPT»r  GP/  OVSTP#  X2L»  XS1L» 

S KSCiLl,  KSCAL2,  LC,  PMILAG,  AE02, 

S YDT,  AOJPhl,  PSlNOw,  A15,  TFJ5,  TF15C,  UFl.  UFIC.  UF?,  9H0,  SH, 

S TFl,  TO^t,  ATGSE,  ATSW,  VHTN,  GH,  GOH,  GOF,  ATG8N,  PPN,  TOC»  TC» 

% HPTP,  TDCA,  TOCAV,  TOCAT 
LOGICAL.  SENS^,  SO,  F7IHE,  MA6LGS,  GSCORT 

integer  GSSW,  LATSi*-,  IT,  GSIT,  MODE,  MODELA,  ICOUNJi  ITAPE 
COMYON  TM,  PHI,  QYEP,  PSIEMH,  PSIECP,  OM,  TQM,  QM,  UO,  Z, 

$ RA,  PE,  RD,  AY,  RH,  QHO,  OH,  GOB,  GAME, 

S GTE,  CT'-,  ‘^H,  OH,  CwH,  SWH,  AEOl,  VHG,  6AMH,  PHICL,  KY, 


% 

S 

PHICT,  PHIC, 
PHILS, 

HPHIC , 

PHI  I , 

phold 

; VPTP; 

GP, 

OVSTP, 

X2L, 

XSIL, 

s 

$ 

GL,  Fk,  RRH, 
DUMMY, 

QL02, 

TPLAT, 

XKL, 

SOUM,  CDUH, 

PL,  RL 

; IT, 

5 

YDT,  ADJPHL, 

P S I N 0 W 

, M5, 

TF15, 

TF15C, 

UFl 

; UFIC, 

UF2, 

SHO,  SH, 

s TFl,  TDM,  ATGSE;  ATSW,  VHTN,  GH,  GDH,  GOF;  ATGSN,  RPN,  TDC#  TC, 
S HPTR,  TDCA,  TDCAT,  LC, 

5 LATSW,  PTIMP, 

% YYYXX,  ICT“. 

data  AONAfii,  aDN4(2)  / UHOFOC,  aHOA  / 

DATA  mode  / ? / 

data  ItApE,  imp,  IICTl^,  IRH,  lATSH  / 0,  I,  0,  0,  0 / 

DATA  TRGS(n , TPGS(2) ,TRGS(5)/  0.0P752«S6,  0.0951125;  0 . 0 1 ^2222222/ 
data  RG(1),  RG(2),  RG(31  / 7.P175E-7,  1.5625E-6,  3.125E-6  / 


call  AFAULT 

PRESETS 

ICTN  = IICTw 

gl  ( n s 0.0 
oGsm  s 0.0 
TRLATCn  s 0.9753099 
TRLATC2)  * 0.90a837«l 

CAgL  GSHYINC  IERR,  660  3 

call  7M0V(2a,»i6) 

CALL  .JMCNCiii) 
call  QMONn53 
call  OMONtlS) 

CAj_L  QMONna) 

call  QSSECnI  IERo  3 

set  TIMf.  SCALE  TO  NORMAL  SECONDS  FOR  THE  ANALOG  LOGIC 

call  QSOUNC  IE»R  3 
CALL  GSSTO°C  ItRW  3 

T'IR'.  aoalOG  LOGIC  ON  AND  OFF 

call  DSIC  ( TERR  3 

PLACE  The  4MA1.0G  COMPUTER  IN  IC  MODE 
call  GHON(?i,4DN4(13,3;'?50,'163 
IF  ( SEN5"(33  3 GO  TO  7 
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TYPE  <?5a 

accept  <>01,  IC‘jTRL 

IF  ( ICNTPL  .LT.  I .OP,  ICNTRL  ,ST,  5 ) 50  TO  1 
r.O  TO  ( 2,  3,  ti,  5»  6 ),  ICNTRL 

2 CONTI'^iUE 
TYPE  P12 
ACCEPT  POl,  INF 
TYPF.  P13 

ACCEPT  POl,  IICTw 
ICTft  a IICT-i 
TYPE  PJU 
ACCEPT  901,  IRH 
GO  TO  7 


3 CONTINUE 

GO  TO  7 

li  continue 

TYPE  9?0 

accept  901,  IAT9< 
GO  TO  7 

5 CONTINUE 
GO  TO  7 

6 CONTINUE 
type  910 

ACCEPT  901,  ITAPE 

7 continue 


C ***  POwfP  CLEAR 
ICOUNT  * 0 
X 5 O.OIS 

C ...  INITALIZE. STACKS  I, 

HCOELA  a 0 
PWOLO  a O.OS 

C NEED  FOP  HOG, MODE 

00  75  I » 1.  9 
OAvfn  s C.OS 
75  CONTINUE 

call.  O-^eOAS  ( OAV,  0,  8,  lEPR  ) 
call  5ST0A 
C ZERO  OAC 

CALL  GP?LLT  0,  SO,  lERR  ) 
fl  call  QflSLLt  0,  SO,  lERR  ) 

IF  ( .NOT,  90  ) GO  TO  8 

CALL  GSOPr  IE9P  ) 

GO  TO  10 


C 

9 


* • * 


1 


i: 


!j 


3TARY  CF  PROGRAM  LOOP 
CALL  OfiSLLf  0,  SO,  lERR  ) 
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oor>ooooor»ooofioo 


r 


1 0 


1 1 


11^  ( ) no  TO  10 

( .NOT,  SO  1 GO  TO  <» 

continue. 


IF  ( SFNSWd)  ) GO  TO  500 
AflO»T  Sun 

IF  ( ( Moot  .EO.  2 ) .AND,  ( X ,LT,  0,pOS2S  ) ) GO  TO  500 


12 


IF  ( .NOT.  SENSW(?)  ) GO  TO  11 
TYPE  «»00 

ACCEPT  <101,  MODE 

continue 

FTIMf.  s .false. 

IF  ( modela  .eg.  mode  ) GO  TO  12 
FTImE  e .T«uE. 

MODEL  A c MfjOE 
GOTO  PSTART  S, 

LATSw  8 1 

NABLGS  = .FAL.SE. 

GSCOPT  3 .false  . 

G s s 'A'  8 a 
H0G03  8 O.OS 
CONTINUE 


INPUT  CONVEPSION 

CALL  0P8ADSI  ADV,  0,  18,  lERR  ) 


IF  ( MODE  .NE.  2 ) GO  TO  13 
SCALED  analog  values  **  ILS  ** 


( PADIANS,  KNOTS,  MM  J 


TM 

* 

PI 

B 

40V(9) 

* 

100,0/57.2957795 

PHI 

* 

PI 

a 

ADV(6) 

* 

100.0/57.2957795 

PSI 

* 

a 

ADV(5) 

* 

200,0/57.2957795 

qm 

* 

PI/32.0 

40Vf3) 

* 

300.0/(57.2957795*75.0) 

GM 

* 

PI/128.0 

B 

ADvn  1 ) 

* 

300.0/(57,2957795*214,29) 

UO 

* 

840.0 

a 

AOV(7) 

* 

1000,0 

Z 

* 

1.0 

B 

A0V(8) 

* 

2000.0  FT  / 6076.1155  FT/NM 

X 

* 

32.0 

a 

ADvn  ) 

* 

20,0 

Y 

* 

PI 

c 

A0VC2) 

* 

l.O 

DTP 

PI 


57.29577<»5 

3.141592653 


T« 

DM 


* A0V(91 A0.55556S 
8 ADV(3T*0.711 IIS 


ONP  ■ -0.50‘’87«i*ADvC15) 
GM  B ADvn'l  )*0.995S4S 
GGAm  8 0.05S5»5S*Ar)vn0I 


7 8 
X 8 
Y 8 

PHILS 

RRM  e 


ADV(A1*0,32976S 
AOvn  1 *0.6255 
AOVC2)*0.31 831S 

8 SS09T(  (xa0.04688S)8(X*0, 046888)  ♦ Y*Y*0, 009648  ) 
SHILS 


GO  TO  14 
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oooooooonoo 


13  CONiTiMUE 

scaled  AMALOr,  VALUES  **  7ACAN  a*  ( RADIANS#  KNOTS#  NM  ) 


PHI 

H 

PI 

8 A0V(6)  A 100,0/57.2957795 

PSI 

* 

PI 

* A0V(5)  A 200,0/57,2957795 

QM 

* 

PI/16.0 

8 ADV(3)  A aOO. 0/(15, 0a57, 2957795) 

UO 

* 

SRO , 0 

8 ADV(7)  A 1000,0 

X 

* 

512.0 

■ ADvd)  * 200,0 

Y 

* 

32,0*PI 

a A0V(2)  A 20,0 

C*"  s ADV(3W0.<i2l«7S 
rjNF  3 -AOVnSW0.5P83SS 
X s ADVn  )*0.3R06?S 
V 3 AOVf2)*0,19e9i»3 
RH  = 5S9DTC  x*X  ♦ YAVAO.OieSSS  ) 
C MUST  DISCRETIZE  RANGE 

\ii  continue 

s ADV{17)/0.9S 
gam  X -ADVCU5/0.9S 
PSI  B AOVf5)/0.9S 
PSIEMH  3 PSI 
PSIECR  * PSI 

PHI  ■ A0V(6)A0. 5*55568 
UO  • ADVf7)/0,»PS 


GO  TO  ( 100,  aoo,  aoo  )#  MODE 
C HOG  ILS  TACAN 

C GO  TO  MODE  SWITCH(MODE) 


C MCf.  .mDG.CO'^pT  PSIEMH  ) 

100  continue 

ifcni  3 mh  . PSI MM 

PHTC  3 XMAMhOt  AEDl,  UO  ) 

IT  s 0 

CALL  L47FIN(  0,99999  ) 

GO  TO  9 

C GOTO  'XAITLCOP 

iC  ILS  MODE 

200  continue 

-1  IF  ( .NOT.  FTImf  T go  TO  201 

L RA  • 0.15625S 

“ RH  3 0.15D25S 

5|  Av  8 O.is 

[ call  LATIC 

' LC  3 0.371363 

' Pin)  ■ 0,09«30U 

PL(6)  3 0.0O0O00375 
PLMn  * 0.O065536 

' PL(16)  8 0.000OC00238Rlfl 

t GL02  s 0.0119395325 
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OL(55  a 0.no(^  1086717952 
QL(9)  * 0,00003917558372 
T«LAT(3)  a 0.01^*22222222 
C XXXX  T^E  FOLLO^IkjG  is  POR  G3  ALT,  HOLD  MODE 
AW  o z 
TMFl  a TM 
WF15  a 2 

C ILS,CO*'‘^C^ 

201  CO^TIMJE 

IF  ( IT  .GT.  0 ) GO  TO  202 
XKL(l)  a OM 

XKL(2)  a -C,ue73S*U0*SlNX(  PSIECR  - 0,0J125S*QM  )/RH 
QOB  a Xi<L(2) 

202  continue 

I?  ( SA95C  ) ,LE,  0.63999S  ) 

* R4  8 0.^673S*VMG*SINX ( 0.0312SS*QH  - GAMH  )/ODB 
HE  a t<H  - 0.00080S*VWG*CO$X(  GAMH  ) 

RO  a RA  - »t 

IF  ( ( 3ABSCQH)  ,LT.  0.17729S  ) .AND.  ( LATSW  .HE.  1)  5 
S AY  8 0,95S*AY 

HM  a 9E  + ^YKrSLIMITf  0.0625S,  90  ) 

IF  ( Rw  ,lt.  0.1S-S25S  ) RH  a 0-.  15625S 

IF  ( GSC09T  ) RH  a 9E  ♦ 0,1S*(  SH  - »E  * 0,096888  ) 

IF  ( IRH  ,F.O.  I ) BH  a RHILS 
A£D1  e 0 ,006798  ^ . 

AED2  a 0.03958S 

call  LATCO'M  RM,  0.99999S,  QM,  AE02,  AEOl,  0,170-008,  0,999998  ) 

KY  a 0,10295S/(  0,1  1 0678  0 . 889338*8  A8S  ( OH  ) ) 

PMICT  a ( KV*GW  * qo3  )/0.68733S 

GO  TO  ( 210,  215,  220  ),  LATSW 

C mhCGm? 

210  C0'*TINUE 

Aem  a MM  « PSIECR 

PHIC  3 tMAMwDC  AEDl,  UO  ) 

C LOC. BEAM, SF'jSOR, ETC 

IF  ( SENSm(<j)  ) GO  TO  212 
»L  ■ 0,0 

IF  ( 8A68(  QH  1 ,LE.  0,568898  ) GO  TO  211 
IT  a 0 

RH  a 0. 15625S 
GO  TO  225 

211  COnTImUF 

RL  ■ 0,000016389 
IT  a IT  * 1 

IF  ( IT  ,LT.  30  ) GO  TO  225 
PL  a 0.0001638U 

IF  ( ((Rw  ,GT.  0.31253  ) .AND,  ( 8A8S(  QH  ) ,GT,  0,926678  ) ) .OR. 
5 f ( RW  ,i_F.  0.31258  J .AND.  ( SA8S(  QH  ) ,GT.  ( 0,566898  • 

$ 0.98809S*RH  ) ) ) ) go  TO  225 

IF  ( 0.07111S  ,GT.  SA8S(QH)  ) GO  TO  212 

IF  (8ARRCPM1CL)  ,LE.  ( 0,011113  ♦ 0 . 06253*8 A8S ( QH  ) ) ) GO  TO  225 

212  CONTINifE 

RL  • 0,00016389 
LATSW  a 2 
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n n r% 


I 


NAf^LGS  3 .true, 

C LCiPTU^E.COnP 
215  CQ»-T  I muE 

PHlC  3 PMKL 
C LOC.CAP. TO, TRACK 

IP  ( 0,071115  ,GT,  SABSrOH)  ) CO  TO  2U 
IP  ( ( O.lOfchSS  ,GT,  SAHSCOH)  ) ,AN0,  ( 0,111128 
5 ,GT,  SABS(GAMh)  ) ) go  to  2U 
ir  c '(  -0.106658  ,GT.  OH  ) ,ANO,  ( GAMH  ,6T,  0,111128  ) ) 

$ GO  TO  Zih 

IF  ( ( 6h  .GT,  0,1066S8  ) .AND,  ( •0,111128  ,6T,  6AMH  ) ) 

$ GO  TO  216 
00  TO  225 
215  CONTINUE 

LATSw  3 3 

HPHlC  3 PHIC  • PHICT 
»C  3 0.001636« 

C LTRACK.CO^lP 
220  CONTINUE 

AY  3 0,5a25S*AY 
PHIC  3 mPHIC  ♦ PHICT 
HPHlC  3 HPH1C*0,998 

IF  ( RH  ,L£,  0,156258  ) PMIC  ■ RH*PHI C/0 , 1 5625S 
C CTH  3 0,0S 

225  continue  « 

CAUL  LATFlNt  0,99999  ) | 

GOTO  -lAITLOOP  \ 

THE  FOLLOWING  IS  FOR  PGH  ERROR  TRACKING 
KAG,  OF  RH  ERROR  & 10,0  NM 
AE01  3 ( RH  - RHUS  J /0,3125S 
CALL  OwJOAS(  AEOl,  0,  IE»R  ) 

C hag,  of  AEOl  3 ( CTW  3 ) 100,0  KNOTS 

AEDi  3 CTw/0,llR05S 
CALL  Q’"J0AS(  AEOl,  I,  lERP  ) 

C hag,  of  AEOl  3 QH  ERROR  s 30UAMP8 

AEOl  3 ( CM  . OH  )/0,15S 

IF  ( INF  ,Et3,  n AEOl  3 ( OH  • QNF  )/0,15S 
call  OwJOAS(  AEOl,  3»  IE9R  1 

AEOl  3 -0.aa300S*U0*5INxc  G'AM  - 0,03125S*QNFJ/RHU8 
AEOt  3 00?  • AEOl 
call  OwJOASC  AEOl,  a#  lERR  J 


1 

. C G8,1NIT 

IF  ( ( (&H)  ,CT.  0.398228  ) .OR,  ( ,N0T,  NABLGS  ) ) 
j S GO  TO  350 

IF  ( GSSh  ,NE,  a ) go  to  301 
’ 300  continue 

! GSSw  3 t 

GSIT  3 0 

CH  8 CH 

SH  3 0.a5837S*Z/(  0,6«S  • 0,36S«GH  ) 

ATGEN  s 0.0138PS  ♦ TH 

GOH  3 -0,36556S*U03SINX(  ATGSN  )/SM 
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GC'F  s 
VHT^  B no 
UFl  a UO 
ATSW  B o.OS 
UP2  a O.OS 
TF15  e TM 

TF 1 3 TM 

CALL  «ALCL0(  SfKGS,  PGS  ) 

XKCSfn  a 0.25S*G^' 

XKGSC21  B Cv’)H 
PGSfn  s o.lOQOfepe 
Pa3(A>)  3 0.01378051757 
PGSn  1 ) s 0.  109C688 
PGSnei  s 0.n00  1 35507U3fe4 
QGS(21  = n.  00023?''737791 
0GS(3)  B 0 . 0n0637‘^u?« 

QGS(<i)  r 0.00252U766367 

C GS. common 
301  rn-iT  I ni'E 

A 15  s O.^OtiA'jS 

Jf  ( GSCOf^T  ) fits  e O.P<?335S 
T?lS  a At  5* f Tr 15-TV)*TM 
TF'lSC  = 7M  - T(T15 
ijFl  = 0,P84i?05*(  UFl  - UO  ) ♦ UO 
UFlC  s UO  - i)Fl 

liF?  s 0.‘)8U?0S*(  UF2  - UFlC  ) * UFlC 
SHO  = $H 

SH  s 0.9S*5M  ..  0, 00066S*VHTN*COSX  ( ATGSM  ) * 

S 0.0a58us*Z/(  0,hUS  - 0.36S*GH  ) 

IF  ( O.OS  ,GT,  SH  ) SH  s O.OS 
7Fl  s 0.90u8jS*(  TFl  . TM  1 f TM 
TDM  c TM  - TFl 
aTGSF  3 &7GS*-  + O.ISoTDM 

ATS/,  s ATS/  - SH  + SHO  - 0 , 00065S<tVMTf4*COSX  ( ATGSE  ) 
IF  ( lATSw  ,rQ.  1 ) atsh  b O.OS 

V/MT\‘  a IJO  4,  4TSH 

FK  r -VHTM*TnM/f  0,173588*SH  ) 

H c 1 . 0 

2'*  a 0.25S*Gm 

IF  ( GSif  ,NE,  0 1 

5 CALL  ^FIL?(  THGS,  XKGS,  H,  ZK,  FK,  SDUMG,  CD(JMG  ) 
GSIT  = ! 

GH  s yKGSni 
GH  s GH/n.25S 
GOh  b XKGS(21 

GOt^  s 0.9S*(  GOF  . GOH  ) T GOH 
aTGS’x  b -0,60952S*GDF*Sm/VHTN 
C TDCA.SU8 

TOCiV  a ( 0.99999S  - VHT N / 0 , U 2 85 7 S ) *GH/0 , 377658 
TOCAV  s TOCAV  ♦ ( 0,8ft328S*GDH  ♦ 0,«ttl6aS*GDF  )/VMTN 
TOCA  s TDCAv*5h  - TF15C 

GQ  TO  ( 310,  315,  320,  550  ),  GSSW 

C OQc-iP  CAP  T9K  idle 

C GS .PP5C  AP .CIH® 

310  COmTImiF 


t 
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o r\ 


: TC.C4P 

( SENSWfS)  ) GO  TC  311 
IP  t f Gh  ) .gt,  O.llfelSS  ) GO  TO  350 
311  COMINUE 

GSSK'  = ? 

GSCP»T  n .true. 

TC  a T»^ 


C GS. CAP. COMP 
315  COnTIMiE 

» P \ s S H * G H 

flPs  = SS1G^(  fiP^,  ATGSN  ) 

TDC  b -0.0231^J5*VHT^:*(  0.5S  - 0,5S*COSX(  ATGS^  ) ) /RPN 
TC  3 TC  ♦ TOC 

►<PTP  a ( TC  - T^*  )/0,33333S  - UE2/0,ie700S 
C GS.C.TO.TPK 

IF  ( GH  ,GT.  0.0613SS  ) GO  TO  325 
GSSW  a I 

TOCAT  a HPTR  - TDCA 

C GS.rrACK.COMP 
3?0  CC'-TInuE 

s TDCA  ♦ TDC  AT 
tOCAT  s C.PE5S*TDCAT 

325  CO'jTI^DE 

AEOl  c -0.155*hPTR 

C T^-E  - SIGN  TAKES  CAPE  OP  THE  OAC  INVERSION 

CALL  Q«JOAS(  AEOl,  7,  lERR  ) 

C MAG.  OP  AEDl  s ATS'a  a 100,0  KNOTS 

AEOl  s ATS*i/0 . 1 1 ROSS 

call  D^JDASf  aeDI,  2,  lERR  ) 

AEOl  a ( Gh  - G«  ) /0 . 1 5S 
call  Q^JOASf  AEDW  fc»  IE5R  ) 

IF  ( OSS';  .EG.  <11  GO  TO  326 
C ONLV  POR  MVQOIO  alt,  HOLO  MODE 

call  kpILK  PGS,  TRGS,  CGS,  1,0,  RG(GSSW),  SDUMG,  CDUMG  ) 
5«J6  COVTINL'E 

IF  ; ITAPE  .ED.  1 1 call  GH0N(  16,  Tm,  ql  1 
IP  ( ITAPE  .EO.  2 1 call  QM0N(  16,  QL»  DUMPy  1 

ICOUNT  ■ ICOUNT  ♦ 1 


GO  TO  R 

GO  TO  *.AIT  LOOP 
***  ENO  OF  ILS  PROGRAM  LOOP 


c xxyxv  THE  POLLOwlMG  GS  ALT.  HOLO  ^OOE  DOES  NOT  EXIST  IN  REAL  PGM 
iSD  CO'iTlN'jF 

IF  f SE'^SUfSl  .ANO,  vaBLGS  .AMD,  6SSH  ,EQ,  a ) GO  TO  300 

T^-Fi  * 0.9R355S*(  THFl  . TM  1 + TH 

TMt-jr  a T'‘  - TmPI 

HPiS  « 0,99355S*(  HP15  - 2 1 ♦ Z 

HFlSC  ■ Z - HPlS 

hPTR  b AH  - 2 - TMPjC  - HP15C  - 0,2bAOV(10) 
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GO  TO  325 


aoo  CClNTlNiJE 
C T4C.IMT 

IF  ( .NOT.  FTIme  ) GO  TO  «01 
CALL  LATIC 
PSlNOt^  s GAmh 
PL(l)  = 0.00297U21i6U 
^Lffe)  s 0.9S3fc'?25019 
PL  (in  s 1.0 

PL(lfe)  s 0 . 00Cy27a696a77 
OL02  = 0.89l9«6a872 
WL(3)  = 0.0003l696972a3 
OL(^)  s 0.00UO878a36l5 

79LATC31  s 0.0002222222222 
LC  a O.OS 
PL  * 0.0305175 


C T4C,C0''“^0N 

aoi  continue 

IF  ( IT  .GT,  0 I GO  TO  U02 
XKLCn  •>  Qt*«M 

XKL(21  a -U0*SINy(  PSIECR  )/0,957(ias 
V2L  = y<LC2l 
XSIL  B GAMH 

a02  continue 

call  LATCO^tO  ,Q9999S,PH,Qm,. O.O0333S,  0,000235,0. 9999<)8,0.20«538) 

GP  B (i,99tJ<?0S 

IF  ( W"  .GT.  0.09766S  ) GP  s 0,097665/RH 
OVSTP  3 0.03281S*U0 
X2L  s 0.9A01SS*{  X2L  - OOB  ) ♦ ROB 
X'SIL  B 0,9B01SS*(  XSIL  • GAKH  ) f GAMH 
YOT  s X2L  « VHG*(  GAMH  • XSIL  )/0,30a76S 
AEOl  = XKl  n ) 

OHICT  B G?*{  4E01  + 0.192S*YOT  )/0,356lS 
GO  TO  ( «10,  ai5,  U20,  a25  ),  LATSW 
C tacm^.comp 

i»10  continue 

4201  s HH  - e>SIEC«  j 

PHTC  B XMANhO(  AECl,  UO  ) '' 

C TAC^H,  TO.CAM 

IF  ( SENS'' (Ul  ) GO  TO  (ill 

C IF  niSCPETf. INPUT, WORD  .A,  LPSO.masK  NEO  0 THEN  GOTO  TPU  S, 

IF  f (yH*S485(0^)  .GT.  0.099U7S  ) 

S ,4N0.  ( IT  .LT.  1 ) ) GO  TO  *130 
IT  a IT  ♦ 1 

IF  ( ir  .tr,  iO  ) GO  TO  *»30 

AOJPhl  5 0.35S  ♦SLI^'ITC  0.155,  ( RH  . 0.13672S  )/0, 520835  ) 

IF  { ( ( PHlCi..*PMlCT  ,LF,  O.OS  ) .OR,  ( SABS(  PHICT  ) ,LE. 

$ ?48S(  P'^ICL  *AOJPhL  ) ) ) ,OP, 

5 ( f SABSf  QH  ) ,LE.  0,088895  ) .AND,  * 

1 ( 5A85(  OHICT  ) ,GT,  0, 005565  ) ) ) GO  TO  <i30 

*ill  CONTINUE 
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LATSIS  a ? 


C TACAPT'JPE.COMP 
<ai5  rO-'JTlMUt 

RL  a 0.030517S 
PSIN-lw  e OSIECP 

IF  { ( SABS(  PHKL  ) ,LE,  SARS(  PHICT  ) ) .AMD. 

« ( rjHtPHICT  ,LT.  O.OS  ) ) GO  TO  Plfe 

PMIC  o P«rCT 
C ITEST  « .TRUE, 

C TACAP.TO.TRK 

IF  ( SAeS(f5M)  ,GT.  0.02P16S  ) GO  TO  ttSO 
LATSV  = 3 
GO  TO  «20 
aife  continue 

PHIC  s PHICL 

C ITEST  a .false, 

GO  TO  «30 

C TAC. TRACK, COMP 
R20  COMTIMIE 

RHIC  s PHICT 
XRH  a 0.03‘»0hS*9H 

«L  B LIMIT!  0.007fr2P0395,  XRH  ) 

PSINDw  s 0,91<i8uS*(  P8IM0W  • P8IECR  ) ♦ PSIECR 
C TTRK.TO.OVS 

IF  ( RH  ,OT.  OVSTP  ) GO  TO  a30 
LATSW  « <i 

C OVS.TO.CAP 
P25  COMTpiUE 

AEOl  a HH  - PSIEHH 
PHIC  a XHAMHOC  AEOl»  UO  ) 

IF  ( RH  ,LE.  OVSTP  ) GO  TO  a30 
C ***  MUST  RE-IC 

LATSw  a ? 

PLfU  = 0.00297«2316<» 

PL(^)  a 0,9S3fe8290l9 
PLnn  a 1.0 

PL(165  a 0,000P27U696a77 

XKLCn  a 0H*RH 

XKL(2)  a -U0*SINX(  PSIECR  ♦ PSIMQW  )/0, 957445 
X?l  t XKl f2) 

XKLC3)  a 0,0 
XKL(4)  a 0,0 
CTw  a O.OS 
GAMH  a PSIECR 
X8IL  a PSIECR 

430  continue 

DRH  m RH 

call  LATFIN!  ORH  ) 

call  OwJOAS!  -QH,  0,  lERR  ) 

AEOl  a CTw/0. 119058 

CALL  OaJOAS!  AEOl,  1,  lERR  ) 

XXXX  a LATSK 
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A£Ol  e 

call  Ga’JDASC  AtOl,  2,  ) 

AEOl  s ( CH  - QM5  /0.30S 
CALL  Qi^JDASC  AEOl,  3,  lE^R  ) 
call  QXJDASC  -009,  a,  1E9H  ) 

IF  ( ITAPE  .EG.  1 ) CALL  QMON(  16,  T^»»  QL  ) 

IF  ( ITAPE  .EG.  2 ) CALL  Qmon(  16,  0L»  DUMMY  ) 

ICO’JM  = ICOUM  + 1 

GO  TO  P 

C GO  TO  »AIT  LOOP 

C ***  E^O  OF  TACA^  PPOGPAM  LOOP 


300  COmTINUE 

call  QSIC(  IEPP  ) 

C oRINiT  OATi 

call  FpRT ( xkl , p , PH  XXL  ) 
call  FPPT, PL, 16,PH  PL  ) 

call  PPPT  CGL,iJ,5H  OL  ) 

IF  ( •^.00“  .FO.  5 .OR.  GSSW  .EG.  « ) GO  TO  501 
call  PPPT  ( xkC,S  , ti  , 6H  XKGS  ) 
call  Fprt  (PGS,  lf),8H  PGS  ) 

501  CONTINUE 

type  911,  ICOUMT 

IF  ( ITAPE  .EO.  0 ) GO  TO  1 

CAlL  0M0N(2iJ,  ' 16) 

550  continue 

call  GMONC21,AONA(1), j, 116) 

TYPE  906 

accept  901,  ‘^noE 

GO  TO  ( 555,  560,  1 ),  MODE 

555  CONTINUE 

00  557  I » 1,IC01JNT 
IF  ( SENSW(l)  ) GO  TO  550 
TF  ( ITAPE  .En.  2 ) GO  TO  556 
call  O-^ONC  17,  TM,  GL  ) 

type  90S,  GM,  QH,  Q08,  RA,  RH,  PHILS,  PSIECR,  GAMH,  UO, 
GO  TC  557 

556  CONTINUE 


call 

Qmom  ( 

17, 

OL, 

dummy  ) 

call 

FPRT  ( 

XXL  , 

9HXKL 

) 

CAUL 

FPRT  ( 

PL, 

16, 

FmPl 

) 

call 

FPRT  ( 

COUN 

» 9 

, 8HC0UM 

) 

557  continue 
GO  TO  550 
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5fe0  CONtKuE 
TYPE  Q03 

ACCEPT  90U,  m,  IT2,  ITS,  ITtt,  ITS,  IT6,  ITT,  IT8,  IT9,  ITIO 

DO  S|6l  I a I,  I COUNT 

IF  (I  8ENSW(1)  ) GO  TO  550 

call  OMON(l7,LOK(n,  LOK(IUO)  ) 

TYPI  905,  LOK(ITn,  LOK(IT2),  L0K(IT3),  LOK(IT«),  LOK(ITS), 

S I L0K(IT6),  LOK(ITT),  L0K(IT8),  L0K(IT9),  LOK(ITIO) 

561  COM  INUE 
GO  |rO  550 


Qf'i'  FQOMATf  • !,  ?,  OP  J FOP  HOG,  ILS  OP  TACAW,  PE8P,) 

901  F0Jmat(T60) 

902  format (/,2E15. 8, /J 

905  FOpMATt  51M  ■ 10-3  DIGIT  INTEGERI) 

909  FORNATC  1013  1 

905  FORmAT(  10S7  ) 

906  FORMATC  6H  s mqdE) 

907  FOPHATf  15H  LONG. AXIS  DATA) 

90S  F0SMAT(  lUH  LAT.AXIS  DATA) 

909  F0RMAT(  9fS7,2X)  ) 

910  format?  97M  r 0,  1 , OP  2 • NO  TAPE,  SF,  OR  FT  OAT,  RESPT.) 

911  FOP^ATMOH  ICOUNT  * , 15  ) 

912  FORMAT?  7H  3 IMF) 

915  format?  8h  s ICTW) 

91<i  FOPmaT?  7H  b IRH) 

920  format?  RH  3 lATSW) 

925  format?  F20.10) 

93?  format?  99H  s 1,  2,  3,  U,  OR  5 FOR  L,  LK,  G,  'GK,  OR  GENERAL) 

END 

C SU«1 


SIJ3RDUTIMF  LATCOM?  PHI,  RH2,  SQM,  KFK,  KCTE,  KSCALl,  KSCAL2  ) 

C LaT. COMMON 

DImEmsiOn  0l?'O,  XKL(9),  TRLAT?a),  COUM(a),  PLC16) 
peal  SOIJM,  SDUmG,  FK,  ZK,  QL02,  DPH,  RL 

logical  FTJME,  SENSw 

INTEGER  IT,  LATS'*' 

SCALED  F9ACTI0N  SA0S,  SSOPT,  SSIGN,  SINX,  COSX,  AT4N8,  SLIMIT 

scaled  fraction  rhils 

scaled  fraction  TM,  phi,  OmER,  PSIEmh,  PSIECR,  QM,  TOM,  GM,  UO,  Z, 
$ SINPHI,  COSPHI,  RA,  RE,  PO,  AY,  RH,  KFK,  QHO,  OH,  QDP,  GAME, 

$ CTE,  KCTE,  CTw,  wh,  oh,  CWH,  ShH,  AEDl,  VHG,  GAMH,  PHICL,  KV, 

I PHICT,  PHIC.  HPHIC,  PHII,  PHOLO,  VPTP,  GP,  OVSTP,  X2L,  XSIL, 

% KSCALl,  KSCAL2,  LC,  PHILAG,  AED2,  PHI,  RH2,  SOM, 

f YDT,  ADJPHL,  PSINOW,  Al5,  TF15,  TF15C,  UFl,  UFIC,  UF?,  SHO,  Sh, 

S TFl,  TOM,  ATG3E,  ATSw,  VHTN,  6H,  GDH,  GDF,  ATGSN,  PPM,  TOC,  TC, 

> t HPTP,  TOCA,  TOCAT 

COMMON  TM,  PHI,  DMEP,  PSIEMH,  PSIECR,  QM,  TOM,  CM,  UO,  Z, 

$ PA,  RE,  RD,  AY,  .PH,  OHO,  OH,  ODB,  GAME, 

3 CTF,  TTi,.,  ww,  nw.  rwM.  aEDI,  VHG,  GAMH,  PHICL,  KY, 

, *’HTC,  hPhIC,  PHII,  PHOLO,  VPTP,  GP,  OVSTP,  X2L,  XSIL, 

S PHILS, 


i 


t. 


f 


i . 

1 I 

i , 

i ■ 


t 
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» OL,  Px,  rjLO?,  TPLAT,  xkl,  SOUM,  CDUM,  pl,  RL,  IT, 

« 

T VDT,  ADJPhl,  PSI^OX',  415,  TF15,  TF15C,  UFl,  UFIC,  UF2,  8H0,  $H, 

5 TFi,  Ty--',  4TGSF,  4TSW,  VMTK-,  GH,  GOH,  GOF,  ATGSN,  RPN,  TOC,  TC, 

HPTP,  TOCA,  T[;CAT,  LC, 

LATSW,  FT  I ME, 

* xyyxY,  iCTw 
SpjPwi  a SI^J5^(PhI) 

COSPhI  s COSxtPMll 
GL(2)  a TLOP 

IF  ( IT  ,GT,  25  ) QL(2I  « 0.00025  *QL02 
DRW  s RH2 
ZK  B SQM 

FK  b KFK*S1K/PWI*C0SX  ( GAMH  )/(  RHl*COSPHI  ) 

IF  ( IT  ,GT.  0 ) call  KFIL2(  TRLAT,  XKL,  DRH,  ZK,  FK , SOUM , COUM ) 
QHO  a QH 
OH  B XKL  C 1 ) 

QH  s QH/RH2 
OOP  = XKL(?) 

game  a GAMh  ♦ 0 ,00060S*SI^PHI/ ( VHG*COSPHI  ) 

CTE  = PH*(  QHO  - QH  1 - KCTEwVHGaSINX  ( GAME  ) 

CTE  s SLIMITC  0.02572S,  CTE  ) 

CTw  = CTw  + CTE/LC 

IF  ( ICTx  ,EQ.  1 ) CTW  s 0.05 

V.H  B 3A0S(  CTW  5 

OH  3 SSIC-N(  n.5S,  CT«  ) 

C^^H  s wHtCOSXf  QH  - P8IECR  5 
, SwH  a ^H*s!MV(  OH  - PSIECR  ) 

A EDI  a DO  * C'-'H 

VHG  a SSQRTC  Sv^h*SwH  + AEOJaAEOI  ) 

GAhh  a PSIEC»  ♦ ATANflC  SxH,  AEDl  ) 

AEOl  s K5CAL?*VHG*VHG*(  0.499995  • 0 , 499998*C0SX ( GAMH  ) ) 

AE01  s -FSlG^f  AEOl,  GAHH  ) 

AED?  s KSCAL1*RH*SABS(  QH  ) 

PhiCL  a »T >nF  r AEOl  , A£02  ) 

END 

C SUB2 

SURPCIITINE  LATPlHf  XRH  ) 

C LAT  .F  IMSh.CQm^OM 

DlfiEx-SIOH  Ql(ti),  XKL(4),  TRLAT(U),  C0UM(4),  PL(16) 

REAL  SDU»^,  SOUMG,  FK,  ZK,  RL,  XRH 
logical  FT1“E 
scaled  FRACTIQSI  sli^it 
SCALED  FMaCTIDN  RhRS 

'*  scaled  FhaCTIOm  TH,  phi,  OheR,  psIEMH,  PSIECR,  Qm,  TQM,  GM,  uO,  Z, 

S SI^PHI,  COSPHI,  RA,  RE,  RD,  AY,  RH,  KFK,  QHO,  QH,  OOP,  GAME, 

1 % CTE,  KCTE,  CJ-^,  wH,  QH,  cxH,  $WH,  AEDl,  VHG,  GAMH,  PHICL,  KY, 

I 5 PHICT,  PHiC,  hphic,  PHii,  PMOLO,  VPTR,  GP,  DVSTP,  X2L,  XSIL, 

S KSCALl,  KSC4L2,  LC,  PHRAG, 

II  > VDT,  AOJPHL,  PSlMOw,  Al5,  TF15,  TF15C,  UF I , UFIC,  l'F2,  SHO,  SH, 
S TFi,  T''",  ATGse,  ATSh,  vhTN,  GH,  GDH,  GOF,  ATGSN,  RPN,  TOC,  TC, 

' $ HPT«,  TDC4,  TDCAT,  XPH 

common  TM,  phi,  Dmeo,  PSIEMH,  PSIECR,  Qm,  TQM,  CM,  UO,  Z, 

S PA,  RE,  RO,  AY,  PH,  QHO,  OH,  QOP,  GAME, 

S CTE,  CTh,  wh,.0H,  Chn,  s»iH,  AEOl,  VHG,  GAMH,  PHICL#  KY, 
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1 * 

P-ICT,  PHIC, 

HPHIC,  PHII, 

PHOLO,  VPTR 

, GP, 

OVSTP, 

X2L, 

XSIL, 

i ! 

hhIlS, 

$ 

QL,  fk,  RRH, 

OL02,  TRLAT, 

XKL,  SDIJM, 

COUM, 

PL,  RL 

, IT, 

S 

Dummy, 

S 

YDT,  AOJPHL, 

PSlNpH,  A15, 

TF15,  TF15C 

, UFl 

, UFIC, 

UF2, 

8H0, 

SH, 

s 

TFl,  TD“,  ATGSF,  ATSW,  VHTN,  6H,  CDH, 

GDF, 

ATG8N, 

RPN, 

TOC, 

TC, 

s 

HPTB,  TOCA, 

tocat,  lc. 

$ L^TSw,  PTIME, 

« »XXXX,  ICTV» 

c XX  philag 

Phil  = PHIC  - PHQLO 

PHIC  s PHOLO  ♦ SLiMITf  0.00277?,  PHII  ) 


PHIC  = SUIHIK  0.1667S,  PHIC  5 
PHocr*  s PHIC 

VPTP  s ( PHIC  - PHI  )/(-0,b5S56?) 

the  . SIG?^  TAKES  CARE  OF  THE  DAC  INVERSION 
call  S^.J0AS(  VPTR,  5,  lERR  ) 

IF  ( IT  ,C.T,  0 ) CALL  KFILK  PL,  TPUAT,  CL,  XRH,  RL,  80UH,  COUM  ) 
RETURN* 

END 

SUB3 

SUPROUTINE  KFILlf  P,  TRANS,  0,  H,  R,  SOUM,  CDIJM  ) 

CIHENSION  P(lfe),  PPdfcl,  TRANS(a),  Q(a),  COU^(a),  DUM(16) 

CALL  KMATRX(  OUM,  TPANS,  P ) 
call  KMATPX(  PP,  TRANS,  OUH  ) 

PPffel  a PP(6I  * 0(2) 

PP(U)  = PP(U)  ♦ 

PP(16)  a PP(lfa)  ♦ 

DO  1 I a 1,0 
J c 0*(I-n*l 

K c 0*(I-n+3 
COUH(T)  a PP(J) 

SDIJH  a CDUMfl)  ♦ 

DO  2 1 8 1 ,0 
DO  2 J a 1 ,0 
K a 0*(I-1 )+J 
L a 84j 

P(K)  8 PP(K)  • 

RETURN 
END 
6UR0 


0(3) 

Q(^») 


♦ H*PP(K) 
CDUH(3)*H  ♦ 


CDUH(1)*(  PP(J)  ♦ PP(L)*H  )/80UH 


SUBPOUTINE  t<FTL2(  TRANS,  XK,  H,  ZK,  FK,  SOUM,  COUM  ) 
DIMENSION  TKANS(O),  CDUM(U),  XKP(U),  XK(«) 

XKP(t)  a XK(n  ♦ TRANS(3)*XK  (2) 

XKP(?)  s XK(2)  ♦ o,026ouoaouoa*(  xk(o)  ♦ fk  ) 

XKP(3)  3 TRANS  ( n*XK  (3) 

XKP(O)  S TPANS  (2)<rXK  (0) 

SDUH3  a w*(  ZK  - XKP(3)  ) • XKPd) 

DO  1 I a 1 , 0 

XK(I)  8 XKP(I)  ♦ CDUM(I)*S0UM3/S0UM 
RETURN 
END 
SUPS 

SUBROUTINE  KMATRX(  RES,  TR,  M ) 
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»EAL  ►I 

DIMENSION  »ESn6),  TR(U),  M(ife) 


»ES(  1) 

B ri  ( 

1 ) ♦ TR(5)*M(  5) 

RES(  S) 

a M( 

2)  + TR(3)*M(  <b) 

RES(  R) 

S M( 

3)  + TR(3)*H(  7) 

RFS(135 

a M( 

0)  ♦ TR(3)*H(  81 

RES(  ?) 

X M( 

5)  *■  0 ,0?BuauuutiuauaitM(ii) 

RFS(  fc) 

S M( 

f>)  f 0 . 0?84uaa ucauatiAM  ( I a ) 

RESnO) 

s 

7)  ♦ 0 , 026auautiaau<io*M  ( 15) 

RFS(lu) 

X h ( 

8)  + 0.028«4auaua4ii4*M(i6) 

RES(  3) 

sTR( 

1 ) * M(  9) 

REST  7) 

3TS( 

1 ) * “(10) 

^rr  ...i 

W ‘l  K ( 

1 ) * M ( 1 1 ) 

pf  sn^) 

BTP  ( 

n * m(i2) 

MES(  U) 

= TR( 

2)  * M(13) 

PESC  B) 

cTP  ( 

2)  * M(14) 

RES (12) 

STR( 

2)  * M(15) 

RESdfe) 

xTP  ( 

2)  * m(16) 

RETURN 

END 

5U36 

ii 


i 


SUa'-^OUTlNE  latic 

C L * f . T ‘J I T 

DI^^ENSION  QL(a)»  XKL(«).  TPLAT(a),  COUM(U),  PL(U) 

real  SnU^*,  SDUMG,  FK,  2K,  PL 

logical  ptimf 

scalfo  FRArnn^.  rhils 

SCAIEO  FPArTI0^  TM,  PHI,  O^ER,  PSIEMH,  PSIECP,  OM,  TQM,  GM,  UO,  7, 
S SI'JPHl,  COS3HI,  R4,  RE#  PO»  AY»  RH#  KFK,  OHO#  QH,  GDP,  GAME, 
CTF,  kctE,  CTw,  i»h,  oh,  c*R,  Swm,  AEOl,  VHG,  6AMH,  PHICL,  KY, 
PHICT,  PHir,  HPHlC,  PMJI,  PhOLD#  VPTB,  GP,  OVSTP,  X2L,  XSlL, 

$ KSCALl,  K<?CAL2,  LC,  philaG, 

5.  YOT,  ADJt>HL,  t-SlNOK,  AiE),  TF15,  TFlSC,  UFl,  UFlC,  UF3,  SHO,  SH, 

$ TFl,  TGm,  atGSE,  ATS-*,  V^TN,  6H,  GOH,  GDF,  ATGSN,  RPV,  TOC,  TC, 

S HPTR,  TOCA,  TDCAT 

COMMON  TM,  PHI,  0“EP,  PSIEmh,  PSIECR,  QM,  jqh,  GM,  UO,  Z, 


$• 

RA,  PE,  PD,  AV,  PH,  OHO,  OH,  GOB,  GAME, 

f 

CTE,  CTw,  WM,  OH,  Chh,  s„h,  AEOl,  VHG,  GAMh 

, PHICL 

, ky 

, 

S 

PHICT,  PHIC,  HPHIC,  PHH,  PhOLO,  VPTR,  GP, 

nvsTP, 

X2L, 

XSlL, 

$ 

RHILS, 

S 

QL,  Fk,  PPH,  GL02,  TRLAT,  XKL,  SOU^,  COUM, 

PL,  RL, 

IT, 

s 

OUMmv , 

s 

YOT,  aOJPhl,  pSINOh,  A15,  TF15,  TF15C,  UFl, 

UFlC, 

UF2, 

SHO, 

SH, 

s 

TFl,  TDM,  iTG^t,  ATSw,  VHTN,  CH,  GOH,  GOF, 

ATGSN, 

RPN, 

TOC, 

TC, 

s 

HPTR,  TOCA,  TOCAT,  LC , 

$ 

LATSw,  FTIHP, 

s 

YXXXX,  ICTH 

call  KALCL»(  XKL,  PL  ) 

PL  B 0.0 

; IT  a 0 

1 GM  3 GM 

CTw  a O.ns 

' •"  VHG  B UO 

GAmh  a PSIECR  * 

PHOLO  X PMl 

PHILAG  a o.OS  I 
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PET'J‘>N 

E^0 

SU97 

SURi^OUTlNE  KALCLPC  XK,  P ) 

OI^'E^SIO^'  XK(U),  P(16) 

00  1 I = l,ii 
XK(I)  s 0.0 
DO  I J « l,U 
K = U*(l-n+J 
P(K)  8 0,0 
PETUPN 
END 
SU39 

SCALED  fraction  FUNCTION  XmaNHOI  X,  UO  ) 
scaled  fraction  X,  UO,  CHH,  SLIMIT,  AEOl 
GHH  s ( UO  - 0.557U5S  )/0,53572S 
GHH  a SLl'^ITt  0.33333S,  GHH  ) ♦ 0, 666668 
AEDl  a SLIMTK  0.16666S,  X ) 

XMANHO  a GHHAAE01/0.33333S 
RETURN 
END 
SUB9 

scaled  fraction  function  SINX(  Y ) 

scaled  fraction  X,  Y,  AO,  Al,  A?,  A3,  A«,  SABS,  SSIGN,  X2,  AEOI 
Data  AO,  Aj,  A2,  A3,  Aa/  0.57079S,  -0.6«596S,  0,79688S, 

» -0.R6722S,  0.01508S  / 

X s Y 

ONLY  NEED  FOR  HV6RID 
IF  ( 0.55  ,GT.  SA0S(  X ))  60  TO  2 
IF  ( X .EO,  -0.5S  D GO  TO  1 

X 8 SSir,N(  0,99999S-5ABS  (X) , X ) 

IF  ( X ,EQ.  4.0,999998  ) GO  TO  2 
X e 0.9999es*x 
X r X 4 X 
X?  a X*X  . 

AEDl  a ( A3  4.  AU*X2  )*X2 
AEOl  a f A2  4 0,lS*AEOl  )*X2 
AEDl  s { A1  4 0.1S4AED1  )4X2 
SINX  a x*(  AO  4 AEOl  ) * X 

RETURN 
END 
SUB  10 


scaled  fraction  function  COSXt  Y ) 
SCALED  FRACTION  X,  Y,  SiNX 
X a Y 

ONLY  NEED  FOR  HYBRID 
X a 0.5S  4 X 
COSX  a SINX(  X ) 

RETURN 
END 
SUBl  1 
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SCALED  F'^ACTTOn  FijncTIOL  ata^8(  V,  X ) 

SCALED  FhaCTION  X,  Y,  SARS,  Af.s^EfJ,  Z,  ZZ,  At,  A?,  A 3 , 80  , B I , B2 , 6 3 
DATA  At,  A?,  A3,  RO,  Pi,  P2,  83  / 0.1R759S,  O.llOajS,  O.OOUIUS. 

« 0.05S59S,  0.ftii527S,  0,UlR5aS»  0.18106S  / 

IF  ( sars(  X ) ,kje.  sabsc  V ))  go  to  1 
ANSWER  a 0.25S 
GO  TO  2 

1 CO^'TI^iUE 

Z 3 X/Y 

IF  ( SArS(  X ) ,GT.  SA8SC  Y ) ) Z 3 Y/X 
Z a SA8SCZ5 
ZZ  a 0.12S*Z*Z 

A^Sxfw  c Z*(  90  * Al/(  ZZ  ♦ 81  - A2/(  ZZ  ♦ 82  - A3/(ZZ  + 83))n 
( SAriS(  Y ) ,GT.  SABSC  X ) ) ANSwER  b O.BS  • AKSl^ER 

2 CONTI‘Jl.iE 

IF  ( X ,Gh,  O.OS  1 Gn  TO  3 
AAJiWER  , ..V9999S  - ANSWER 

3 CONTUUE 

IE  ( Y .LT.  O.OS  ) answer  s - ANSwER 
ATAN8  s answer 
RETURN 
END 

C SUB12 

SCALED  fraction  FUNCTION  SLIBIT(  L,  VAL  ) 

SCALED  fraction  l#  VAL 
SCALED  fraction  SA0S,  SSIGN 
SLIBIT  b VAL 

IF  ( SA0S(  VAL  1 .GT.  L ) SLIMIT  = 8SIGN(  L/  VAL  ) 

RETURN 

END 

C SU913 

real  Function  li^iti  l»  val  o 
real  l 

LI»^IT  = VAL 

IF  ( ARS(  VAL  ) .GT.  L)  LI^"IT  a SIGN(  L»  VAL  ) 

RETURN 

END 

C SUPia 

Subroutine  FPPTf  a,  ne,  title  j 

DIMENSION  A(1SI,  TITLEC2) 

TYPE  100,  TITLEd),  TITLEC2) 

00  1 I a 1 , ME  , a 

TYRE  101,  A(I),  A(I+l);  A(l+2),  A(l+3) 

1 CONTINUE 

100  F0RPAT(/,5X,?Aa) 

101  FORMAT(aEia.ei 
RETURN 

end 

C SURIS 

SURROllTI’iE  SORTf  A,  NE,  TITLE  ) 
dimension  TITLEf2) 
scaled  fraction  A(u1 

TYRE  100,  TITLE(1)»  TITLEC2) 
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100 

101 


TVPP  101,  A(l),  A(2),  A(^),  A(«) 
A CB‘'at(/,5X,2Au) 

F0!?«AT(a(S7,2X) ) 

FETU9N 
END 

0 

«WilS 
AW,  Ife 
«L,CIG, 1« 

«K  , 7000n,  1 01  000, 15000 
«C,  15 

aN,SFOFOP, 15,2 
*G,#>7i00 
«L,0BJTAA, ifet 
aL,OHON,  l'4t 
«L,LI^''<^',  1«7 
*L,RTL,Kt 
aF 

*L,BOEC,  lilt 

«UL 

AEL 

AM 

«r  ,2 


I 


APPENDIX  E 


AED  PROGRAM  LISTING  (SCALED) 


2H1 


t. 


TiIS  4PPfe\0Ii<  PROVIDES  T«E  OEDC  "4ED"  SVSTEM  S0ETW4HE  R I SC  R I PT I ON . 
THTS  •'AEO"  SnP-Tt^tBP  OI5CP1PTION  PROVIDES  THE  "CQHPLETE*'  SOPTWARE 
OOC't'ANT aTTOv  fhr  the  DFOC,  the  VARIABLES  COOED  IN  THIS  SYSTEM 
OISCRIPTIO'i  ARE  OEEInEO  In  appENDIY  8.  THE  FLOW  CHARTS  FOR  THE 
PRTO.&AM  are  illustrated  IN  APPENDIX  A, 


K 


FJFN  AED,*  I':TS»V,  INTSRV 
8FG  IN 

...  DIC-ITal  flight  DIRECTOR  SYSTEM  PROGRAM,  aED  DESCRIPTION  // 

...  **♦**//  PRESET  SI^COUNT  a 0 Si 

...  **♦**//  PROCEDURE  forint,  SIMAC  5, 

...  *♦***//  RROCED'JRE  ASMOCT  %, 

...  ♦****//  real  '3H,vHH,vMC.,GAyw,GH,SH,  ATSW,VHTN,ATGSN  S, 

...  *<***//  Integer  II.sIhcount  $, 

...  **♦**//  Integer  j,koi.'nt  $, 

...  *★***//  integer  procedure  maxCNT,KMAX  J, 

...  *♦*♦*//  REAL  ARRAY  X X ( 1 0 0 ) , C R S E R (1 0 0 5 , L DC D V ( 1 0 0 ) , G S D V { I 0 0 ) , 

...  *«•**♦//  RNGEn00),HPNTPn00),VPNTR(100),  PITCH(IOO), 

...  *.**//  hank  (tool  , ALT  n 00)  ,RHOUT  ( 1 0 0 ) , DHOIJT  C 1 00  ) , WHOUT  ( 1 00  ) , 

. . . ****//  VHGrr.jTM  00)  ,GAMH0(  100)  ,QHERR  (100)  .GHOUT  (100)  , SHOUT  ( 100) , 

...  *.**//  ATS*OMOO),VHTNO(tOC),ATGSNO(100)  St 

...  **«**//  PROCEDURE  PLRF29, NFk.PAG  $, 

...  **♦**//  PRESET  J a -1  $, 

...  ****♦//  preset  KO'jnT  s 1 $, 

...  *«***//  BOOLEAN  PROCEDURE  CHKPT  S> 

...  *.***//  PROCEDURE  CARET  $, 

...  ♦♦***//  PROCEDURE  PRTA  f, 

...  **4**//  DEFI'ir  boolean  PROCEDURF.  SAMPLE  TOBE 

...  ***44//  SEGIn 

...  **♦*♦//  FnRINT(c,iMAC, 10. MATRIX, 15  .A.  DISCRETE. INPUT, WORD)  S, 

...  **«**//  eFFRdft)  s lO.-ATRIX (laC)  S,  ...  BYPASS  DFOPRM  RANGE  // 


****•// 

SIHCCUNT 

a SlMCOUNT  1 

$t 

* * • * * / / 

IF  C*<oT  THEN  begin 

*«***// 

FOR  !IeO  STEP  1 UNTIL 

31  DO 

**«**// 

orta(a<;n'Elpi,0,1u,I0, 

'‘'ATRIX(II)  ) S/ 

* ♦ * 4 * / / 

CAOETO  S, 

Er-’D  s, 

**«*•// 

IF  KOI 'NT  LES  KM4X() 

THEN  KOUNT  B KOUNTfl 

****♦// 

else  BEGIN 

KOL'NT  a 1 

$ 

# 

***«*// 

J 3 J*1  S 

# 

XX(J)  s JaKMAx()*0,05  t. 

r.HSER(J) 

3 

10. MATRIX (20C) 

%t 

*#«**// 

LOCOV(J) 

B 

IO.MATBIx(2EC) 

S. 

«*•**// 

GSDV(J) 

S 

in.MATRIX(2UC) 

St 

♦♦***// 

CNGE ( J) 

3 

lO.MATRixnaC) 

St 

****•// 

HPNTR ( J) 

6 

10, MATRIX!  1C) 

St 

*••**// 

VPNTR(J) 

s 

10. MATRIX!  O ) 

St 

♦ A * ♦ * / / 

P1TCH( J) 

3 

IO.MaTRIx(30C) 

s, 

* A * » A / / 

bank ( J) 

3 

10. matrix  (310 

St 

A A A A A / ✓ 

ALT(J) 

a 

IO.MATRIX(27C) 

S, 

RHOUT ( J) 

s 

PH  S, 

QHOUT(J) 

e 

OH  S, 

j 


I 
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*«*«*// 
Ik  * * * A / / 
**♦**// 
*«*««// 


★ **•**// 
*****// 
**«**// 
****•*// 
****♦// 
**««*// 


***♦»// 
****•*// 
**•***// 
**■***// 
**•**// 
It  it  * ii  it  / / 
♦ ****// 
****«// 
it  * * * * / / 
****«// 
**»**/ / 
*«***// 


♦****// 
***••// 
* * * * it  / / 
it  * * * * / / 


*■****// 


i * i it  i / / 
*****// 
it*  i**  / / 
it  it  it  *.  * / / 
it***// 
*♦***// 
**»«*// 
*****// 


Itit***/ / 
**«**// 
*«**«// 

*«***// 
*****  f / 
*****// 
*****// 
*****// 
*****// 
*****  J f 
*****  f f 
*****// 
*****// 


w»-nUT(J)  n 
V^^GOUT(J)  B V^G  S» 

GAKHDCJI  s S, 

Of*FRR(J)  s (JH  - LOCOV(J)  f. 
GHQiJKJJ  3 GH 
S^mjT(J)  a SH  S, 

ATS/-0(J)  * ATSW  $, 

V^•T^^(JJ  3 VHTN  S» 
ATGSNJOCJ)  a 4TGSN  S, 

IF  SIMCOUST  GEQ  MAXC^T^ 


THEM 

MEv. , OAG  n 

BEGIN 

sample  s true  S, 

? . 

RRT(0, .C. 

/COi.iPSE  ERROR 

/ ) s. 

ME'W.P.-.G() 

F0RlNT(OL-Rr2R,XX, 

«, 

CRSEP, 1 ,100,100) 

s» 

®»T(0,  .C. 

/localizer  OEV 

/ ) S, 

NEW, PAG  n 

FORINT (PLRF2R, XX, 

s , 

LOCOV,  ! , 100,100) 

s. 

PRT(n,  .C. 

/GS  DEVIATIOM 

/ ) s. 

mPw.paGO 

F0RIMT(PLRF29, XX, 

5, 

GSOV, 1 ,100,100) 

s, 

PRT(0,  ,C. 

/RA‘jGE 

/ ) $, 

Ai£w  .PAG  ( ) 

F0RImT(PLRF2R,XX, 

s, 

PNGE, 1 ,100,100) 

*» 

PRTCO,  .C. 

/HORTZ  POINTER 

/ ) $, 

ME-.PiGO 

FORINT (PLRF29, XX, 

MPNTR, 1,100,100) 

$ A 

PPT(n,  .C. 

/ V£PT  POINTER 

/ ) s. 

ME  ^ PAG  n 

FORINT  fPLPF29, XX, 

S , 

VPNTR, 1,100, 100) 

s. 

PRTfO,  ,C. 

/PITCH  avgLE 

/ ) $, 

MEw, PAG  f ) 

FOPINT (PLRF29,XX, 
«, 

PITCH, 1,100, 100) 

s. 

PRTfO,  .C. 

/SANK  A^GLE 

/ ) s, 

NE-'.PAGC) 

FORINT (PLRF29, XX, 

s, 

BANK, 1 ,100,100) 

s. 

P=T(0,  ,C. 

/ALTITUDE 

/ ) s. 

ME  w,  PA  GO 

FORINT (PLRF29,  XX, 
«, 

alt, 1 ,100,100) 

s, 

PRT(0,.C. 

/RH  estimate 

/ ) S, 

FORINT {PL^F2R|Xy,RH0UT, 1,100,100)  S, 
^'E^J.OAGO  ?, 

PRTfO,.C.  /CH  ESTIMATE  / ) S, 


FORIMT(PURF2R, XX,OMOUT, I, 100, 100)  S, 
V'E>..?4Gn  $, 

P^T(C',.C.  /^’H  estimate  / ) $, 

FOPI'-'T  (PL»F2q,XX,WHOUT,  I , 100,100)  f , 
»'E.-.P4G()  S, 

P«T (0, .C,  / VMG  /)  S, 

FD»ImTCPLRF2R,XX,vhgOUT,  I , 100,100  ) S, 
•‘-F.i.PAGC)  S, 

PRTf0,.C.  / GAmm  /)  $, 

pn«l*jT(OLRF2R,XX,GAMM0  , 1,100,100)  S, 

NEW.  PAGO 

PPT (0 , ,C,  / GH  ERROR 
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/)  S, 


pnoiKT(PL«F29,XX,QHERR  ,1,100,100)  f, 

$, 

P>5TC0,.C.  /GM  OUTPUT  /)  S, 

F0=?!WT(PLBF2<»,XX,GH0UT  ,1,100,100)  S, 

MEw.PftGt)  $, 

P»T(f>,.C.  /SH  /)  $, 

PORIMTtPLBFaP, XX, SHOUT  ,1,100,100)  $, 

ME*. PAGO  $, 

POT(0,.C.  /ATSW  /)  $, 

FCOINT  (PLWP29,  XX,  AT8i*0  , 1,100,100)  S, 
PAGO  $, 

PRT(P,.C.  /VHTN  /)  S, 

FDRINT(PLPP2P,XX,VHTN0  ,1,100,100)  S, 

^-Fk.paGO  «, 

PPT(0,.C.  /ATGRN  /)  S, 

pOP1K'T(PLPF29,XX,AT6SNO,  1,1  00,100)  S, 

CKPT  a CWKPT  (SI^'COUNT)  J, 

EN'O  «, 


****«// 


POGLEAN  array  B00L0UT(15)  s. 


*★***// 


OEFI^E  PROCEDURE  0 1 G . GUT  ( P 1 T , NiO  , 0 V ALU  ) WHERE 
integer  bit, ho  5,  BOOLEAN  BVALU  TOBE 
BOOLOUT (8IT.N0)  a BVALU  $, 


,,,  «*«**// 

,t,  ■*■****// 

•••  •**♦♦// 

, , , **#*♦// 

, . , *«*•*// 

,,,  **•»**// 


OEFIHE  PPOCEOUPE  0«*CRO . OUT  ( I ) WHERE  INTEGER  I TOBE 
BEGIN 

INTEGER  L S, 

FOR  Lai  STEP  1 UNTIL  16  DO 

BCOLOUTCL-l)  8 ((1  .LS,  (L-D)  .A.  I)  NEQ  0 S, 

FNO  %, 


PEAL  array  lO.HATRIX(Jl) 


• at 


**♦♦*//  define  PROCEDUPE  output  (AODPESvS,PVALU) 
♦****//  WHERE  Integer  address  s,  peal  rvalu 

****•//  10. haTRIX (ADDRESS)  a RVALU  S, 


TOBE 


***«*// 
*«***// 

A nr' 

A !.'D 

ATu  CQH'IENT 


definf  procedure  in.reoue ST ( aoor)  v-here  integer  aoor 

TOPE  hhoLE(IAP,STORA6E)=IO,hATRIX(ADOR)  $, 

define  procedure  In, REQUEST  (Ai)0»)  WHERE  INTEGER  AOOR 
DUHP  a WHOLE  (WHGI.E(LIST,  ADDRESS)  ) J, 

DUHP  cleans  noise  off  stack, also  NOTE  THAT 
CQHPONfeNT  TYPE  OF  INNER  WHOLE  IS  INCONSISTENT  // 


...  global  variables  (COhhON  to  all  3 STACKS)  // 

REAL  PSIEHMOG,PSIECPS,KSlNPHI,KcnSPMl,OM,HSlNR,HCOSP,TSlNR. 
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' t S I ' I c 0 5 , 

TCG5'»,SlvP-tI  ,CDSPhI  ,R-|,UO,T‘^,SDUM,SOUMG,PHI  Si 

RF4L  aio?  «, 

Cr^MOv  Gi'STACK.LATSTAC*',  I^'TSTiCK,  DISCRETE,  INPUT,  WORD,  FIRSTIME, 
PKPR,PPr.S,PGS,OGS,XKRS, 

PPL  ,PL,Ql.  ,xkl,XKPl,COU“,CDUMG,GSCO«T, 

ST‘JBi-I  ,COS»hI  ,pw,  t^',soum,sdumg»mode 
<,****//  ,Ckpt,Ch,i„h,  vhg,GAPH,gw,  ATSW,  VHTN,  ATGSN  ,PHI,NA8LGS 

KfcAL  APPav  r,SSTACK(gg),LATSTACK(99HNTSTACKC99)  $, 

PfAl,  A=RAY  PPG5inb)  .PGSOib)  ,r.GS(U)  ,Xt<GS(a)  , 

PPl.(le).  PLfU),  GL(^),  XKL(<n  $, 

real  array  tPLAT  ,TPr,s  (5)  ,CDU^^(«0  »CDUMG(«)  Sf 
BOPLF.A\^  r.SCCPT,  PIPSTImf,  %, 

I^Tt  GEP  0I5CPETE,  IMPUT.wORD  S, 

IMTtGEP  S, 

POIfTPR  IV.PTP  5, 

***♦*//  BDCLEA\  VA3LGS  S, 

PFESET  TFLATC!)  = 0,'57‘i3099  Si 

PPtSET  TRlATCa)  s 0.90^1637^  S, 

THE  PCl.LO^'I'vG  variables  SHARE  SPACE  IN  9FFR  // 

Ur  = BFPRfro,P3IFHHDG  = e<FFRm#  ...,  T8 1 NRsBFFR  (8  ) , TCOSR«BFFR  (9 ) 

SY^J0^Y''S  BEGIN 

PSIEKHDG  = GH  $, 

PSIF.CPS  s Z %, 

KCCsPHT  = kcg.somega  S, 

KSINPHI  r KSINOHEGA  * , 

QH  s STCl»  TQM  », 
hSINR  r hPTR.lNP  S, 

HCOSR  c VPTP.lNP  S» 

END  %, 


peal  COMPONENT  ^^HOLE  $, 

^.hOLE  «=?  0 «, 

PHncEPnPF  PTR.Flag 
PPAL  FPOCEPLiPF  kalCLR»*<P1LI  »KF1L2  $ 

peal  FPrcEOUPE  SORT,  ExP#  ATAN8, 

PfAL  PROCLO'-'PE  LIKIT.SIGN  S, 

PpncFOijRE'  failure,  WARNING  S# 

♦ **!►♦//  Pnr'LFA^  CKPT  T, 

♦ ****//  pROCEDiiRF  AS^DEC  S, 

♦ **♦*//  FWGCEr-ijRE  ASMFlO  $, 

*♦***//  PDnCEPL'RF  PPT'j* 


ATAN, 


SIN*  COS 


S, 


******^*******tk*«***«****l 


LOCAi,  VARIA5LFS  (LOCAL  TO  THIS  STACK  ONLY)  // 


ThTEp^Ep  9COP,PCuPu  S* 
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DIS.v-CPO.lC 
IMEGEQ  -i^TAS.MASK 
I\T£GE«?  MOOELA  $, 

I^TEGEP  ▼4C.-ASt<»'-w, mask, ILS, MASK, ST, mask, K, LIST, ADDRESS  S, 

BOnLEA»<i  onv'E  *, 
eOOLEAf!  ASRF.F  $, 
cEAL  ASR  «, 

«EaL  AN.r,h,  A^T,T,  anGU.hOIGIT,  T0I6IT,UDI6IT  S, 

REAL  Pr-LO,XSTA»7,KRG,VAVG,SIGA'N  S, 

REAL  CA^GE'J,‘<A^GtT,  VERR,PCOPUT,RlJPT  S, 

REAL  RASGE  S, 

RFaL  ARRAY  eFFR(l I ) # I«FFR(1 n S# 

INTEGER  array  ILS.LIST(«),TAC,LIST(10),ST.LI8T(6), 

ILSA.lt  ST (5)  I, 

...  ***//  RRnCtr''PF  RYIT  S, 

POINTf?  HOG, E K»n», CRS, ERROR, ROLL, SIN, ROLL. COS, LOC. DEV, 

STESTl , ST^  ST?,h,PTR, V,PTR,TAC,0EV,H,S1NR,H,C0SP,T.8INR, 
T, CnSR,  r,  S.  OF  V,  RADAR,  alt, P, SIN, P, COS,  I Np, DISCRETES, 

...  I/C  //  li,SI'-R,l'.COSP,  AS.BEF, 

inr,stoqage,cut,oisc»etes,out,vptr,out,hptr,msk,rec, 

CO^R, aS.mak,  AS  %, 

...  **«**//  INTEGER  PROCEDURE  SET, INPUT  S, 

■ SYnOnV'^S  QEGIN  U b TAG, mask  $, 

1 ■ mh.mask  S, 

2 B ILS.MASK  S, 


8 B 

ST. mask  S, 

END  S, 

SYNONYMS  •‘5EGIN 

21C 

S 

HOG, ERROR 

S , 

20C 

s 

CRS, ERROR 

s, 

12C 

a 

ROLL. SIN 

Si 

13C 

a 

ROLL. COS 

s, 

2?C 

a 

LOG, DEV 

s. 

32C 

•• 

STESTl 

5i 

33C 

a 

U.SINR  S, 

35C 

s 

U.COSR  S, 

3iiC 

s 

AS.RE'F  », 

30C 

s 

H,  PTR 

s, 

31C 

s 

V.PTR 

s. 

P3C 

e 

TAG. DEV 

s. 

16C 

a 

H. SINR 

s, 

17C 

«• 

H.CCSR 

Si 

1«C 

m 

T.SINR 

Si 

15C 

a 

T.cnsR 

Si 

IOC 

a 

P.SIN 

Si 

lie 

s 

P.COS 

Si 

2RC 

a 

GS.DEV 

Si 

27C 

a 

RADAR, alt 

Si 

3fcC 

E 

iNP, discretes  $, 

37C 

E 

INP, STORAGE 

Si 

o?c 

s 

OUT, DISCRETES  S, 

ooc 

a 

OUT  ,VPTR 

Si 

oic 

a 

OUT.HPTR 

77C 

B 

MSK.REG 

Si  ' 

25C 

1 

COMP, AS 
28#> 

Si 

j 


iS 


2^.C  s Mis.is  f, 

t; ' 0 s , 

...  •vCTt  t'^GVF  octal  INDICtS  *ILL  St  PHEFACt.0  wITH  177  // 

I‘,TEC«tw  APday  '“SX.tblCU)  ,^',TeLrS).LST.*0,TBL(SJ  *» 


P-E«;tT  l’I?C 

RETf  ...ORO.IC 

= SROOC  5, 

p ■-  f E T - S •<  . 

Tsi.m  = tac. 

^AS<  S, 

ppe^FI 

T'  L r>)  3 ST. 

A s K S , 

p - f c f T ^ , 

"Bl.f.M  r 

"ASX  3 , 

p p f c t » »•  S »■  , 

T L ( T = US. 

"ASX  S, 

P p f r T K ^ 

' -1L  • t 5 = iiT 

S , 

P t '•  t T ' . 

’'^Lf ")  = R 

5f 

f'PtjFT 

’-LCV;  3 S 

s» 

PC  ^ T 

’ E 1,  ( <0  3 b 

s, 

P P f t T fj  ^ 

tel  TS)  Zb 

s, 

PPt<iET  LP"'. 

AG.T.,^(n  = 

I.OC  TAC. LIST 

s, 

PtEcfT  lST. 

A''.TSl,  f?)  3 

ICC  ST. LIST 

S, 

pi^E.SET  let. 

U ,tc-l(5T  = 

LHC  US. LIST 

5» 

P C c c t Y 1.  E-  T , 

A r, , 7 P I,  ( 'A  T e 

LCC  3LS.LIST 

s, 

P U C C T L S T . 

A f '/  . T • • L ( S ) = 

LOC  Ii.  S.LIST 

PDf  sr 

r 1 s . 1 T s T ( 0 ) 

= HPir,. ERROR 

i, 

ppf  ar  T 

I L r . L I s T f n 

3 CRS. ERROR 

if 

PRt  SE  T 

T l S . A I S T c ? 5 

= roll. SIN 

s, 

Ppf SET 

I ' S . 1 I 5 T n T 

= ROLL. cos 

S, 

PR^  5E  T 

i L r , T T ( A T 

= LCC.DFv 

S» 

P R c a ^ T 

T .*■  '■■  . L I S T f 0 T 

3 HOo.f.^pnR 

s, 

P P c S ^ T 

T AT . L I ST  M T 

3 CRS. ERROR 

s, 

PRESET 

TAC.LlSTf?) 

= POLL. SIN 

i, 

PRESET 

T i C.  , L 1 S T f 3 T 

= ROLL. COS 

p P c S R T 

T .•  C . 1. 1 s T ( - ) 

= TAC.OFV 

S» 

PPESr  T 

TaC.LIST(S) 

3 M.SI^t? 

s, 

P R c S E T 

tac.i  IST(M 

e H . C 0 S R 

PRESET 

i C . L.  I S T ( 7 ) 

3 ^.SINR 

f » 

P w c s E T 

T A r . L I S T ( E T 

3 T.COSP 

s» 

Pht  SE  T 

TAC .list f ^7 

3 U.SINP  s, 

P B E S T T 

T A C . L T S T ( 1 0 I 

= u.cnsR  s, 

P R P S E T 

ST .LIST (OT 

3 *^00. ERROR 

«» 

preset 

ST.l IST(1  ) 

3 CRS. error 

S, 

PRESET 

S T . L I S T f ? ) 

= roll. SIN 

S# 

PRESET 

ST .LIST (3) 

3 roll. COS 

i, 

P--E  SE  T 

' T . u I S T ( A ) 

3 STESTl 

s, 

PRESf  T 

ST. LI  ST  (S3  = 

; H.PTR  s, 

PRE  Sf  T 

ST.  LI  ST  CM  a 

1 V . PT«  S , 

PRESET 

ILSA,lIST(03 

3 G5.DFV 

s» 

PRESET 

I L s A . L I S T ( 13 

= WAOAP.ALT 

S| 

PRESET 

IL5A,lTST(?3 

= P.SIN 

i, 

PRESET 

TLSi .LIST (33 

= P.COS 

5# 

> * * A 

DEFINE  PwDCEnuwE  ^OvE ( P pOM , TU , K ) WHERE  REAL  ARRAY  RrOM,TU  S» 

integer  k tope  begin 


2«7 


r 


lNTf-r.E»  I 

FOa  1=  K STEP  -I  UN-TIL  0 DO 
TU(1)  ■ FROM(n  %0 
IN.PTR  e LOC  BFFR  5, 

F.N‘D  i, 


POC  I 


MODELA  = 0 S, 


PST  AWT* 

...  too  SET.TUiE?.  T^TEPPUPT.MASKO  %, 

...  too  IN-m  ALiZE.STACKSn  A, 

...  <^0:'  PICT  SOI, 

GSCOPT  s false  %, 

NiAi^Lt-S  s false  5, 

GS.IffOEy  = P $, 

D^ORD.OUT  fOISCPETE.wORD.  IC5 

...  1C  s GPDISENRAGFI  HFTP,  VPTR  IH  VIEl^l  FOVALIDI 
ALL  FLAGS  OUT  OF  VIEW  // 

GC'*E  s TRUE  «, 


• • • 
• • • 
• • • 
• • • 


ADD  GOTO  -AirLF  via  IntRTS  5, 

A****//  i-AlTLCfJP  ^ IF  SApplFO  them  EXITH  $, 
***♦*//  IF  timer?  then  TIMEl. interrupt, SERVlCEO 
***^**//  ELSE  TI^E?. INTERRUPT. SERVICEO 


i, 


...  ♦****//  enCLEAM  TIMER?  %, 

...  **//  define  PPOCEOURE  TImei. interrupt, service  TORE 

TM",  HFGIN 

...  ****♦//  TIMER?  s false  I, 

-...  ****.//  IF  CKPT  then  pwT(0,,C,  /checkpoint  3 /)%, 

In-TEGEF  IM.ITSL  %, 

TTPL  s 5 S, 

FOR  IM  = 1 STEP  I UNTIL  n 00 

IF  DISCRETE. INPUT, XORO  .A.  «SK,TBL(Im)  NEO  0 
THEN  ITBL  E IM  S, 

N s N.TBL(ITSL)  $, 

LIST, address  s LST,  AD.TeLdTBU  S. 

MODE  = ITBL  5, 

IF  (FIRSTIm£  s MOOELA  NEQ  MODE) 

Then  begin 

HODELA  s MODE  S, 

GOTO  RSTART  $, 

END  S, 

GOTO  1N»  .F, 

End  T, 


...  **//  PEFIfE  RRf'CEOiJPE  T I m£  g . i ntfRRUPT  , SER  V I CE  TOBE 
Tm?5,  begin 

IF  { MGTf  pr,  ILS.MonE  ) THEN  BEGIN 
...  .*.**//  TIMER?  s TRUE  5, 

...  **♦♦»//  IF  C-^OT  Then  PRT(f',.f‘,  /CHECKPOINT  5 

SET.APPR.MHOEn  5, 

LIST. ADDRESS  a LOC  ILSA.LIST  S, 
N a 5 


i 

i: 


•t 


(i 

II 

! 


I nR  * 
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• • • 


****«// 


IN.PTR  a LOC  IPPTR  $, 

INT.K.0  = 2 

TF  (OISCKETF.,  INPUT, --CRO  ,A,  MANTAS. MASK)  NEQ  0 
THEN  BEGIN  ASHEF  s TRUE  5, 

IN, REQUEST ( AS. REF ) S, 

END 

ELSE  BEGIN  ASR  a i,o  $, 

IN.REQUEST(COMp, AS)  S, 

END  S, 

,,.  *♦**.//  IF  CKPT  Then  PRTfO,.C,  /CHECKPOINT  4 /)S» 

EnO  S * 

. AOD  GOTO  IMT.RF.T  S, 

...  *♦***//  INPUT.IMERRUPT.SERVICEO  $» 

END  S, 


DEFINE  PROCEDURE  SE T . A P PR . MODE  TOBE  MODE  n 6 S, 


...  **♦**//  define  procedure  INPUT, interrupt. service  TOBE 
LP  « PEG  IN 

IF  A.crfF  the*-'  begin 

ASR  5 wKOLECINP. STORAGE)  S> 

ASREF  a false  S, 
iN.RFOUESTfMAN.AS)  $» 

...  AD''  GOTO  INT.RET  $, 

,,,*****//  GOTO  L P S» 

END  5, 

''‘HOIF  ( iv.PTR)  r wHOLEdNP, STORAGE) 

IN. PTH  = IN.PTR  + 1 S, 

IF  {N  s NEQ  0 THEN  BEGIN 

IN.PE^UtSTaiST.ADDRESSsLlST,  ADDRESS  4 1)  i, 

...  ADD  GOT-^  INT.RET  S, 

,,,  t****/ / GOTO  LP  $. 

F N n ^ , 

IF  DONE  THF-j  done  = false  ELSE  FA  ILURE . WARNING  ( ) S, 

MOvE  f IPFFP, BFFR  , 1 n S, 

BFFRfO)  s r.P(rpff;)/4SR  ...  DIVIDE  BY  AIRSPEED  REFERENCE  S, 

TM  = PHI  = atanB(BFFR(3)  .0FFR(a)  ) $, 

...  *****//  GOTO  PNG  s, 

...  dmf:  wa‘’gf.  input  pre-processing  // 

IF  POLE  EOL  1 Then 

aFr,lN 

...  ♦****//  IF  c-'PT  them  prT(0,,C,  /checkpoint  2 /)$, 

...  VHFN  DNF  RivQF  UP-DATE  then  MAKE  A/C  CHANGE,  SCALE  // 

...  //  ANGH  5 AT4Ma(pFfrp(fc),f^PF»f7))  HSINR.HCOSR  S, 

A NG, TO,  DIGIT!  ANGh,  A ED  I ) S, 

IF  ( AEDI  LES  0.5B  ) then  hdIGIT  a AEDl*l.«>5 

ELSE  HOIGIT  B 0.0  S, 

...  //  anGT  a ATAN8fBFFB(B),WFFR(9))  ...  TSlNR,TCOSR  S, 

ANG. TO.DIGI T ( ANGT , ACDl  ) $, 

TOIGIT  = 0.1Rn*aED1  S, 

...  //  ANGU  a ATAvptaFFCMOJ.BFFRni))  ,,,  USlNR,UCOSR  S, 
ANr,.%O.DIGIT(ANGU,AEDn  f, 

UDICIT  B 0,Ol95**Ent  T, 


2«9 


r 


E P s ^ r.  E 0 U P F A N G 
EPE  PEAL  CIGIT, 
BEGIN  4NG  a A 

.TO. DIGIT (ANG, 
anG  T08E 

NG  + 0,1  S, 

DIGIT) 

DIGIT  a 

IE 

4\G 

LES  -0,8 

THEN 

0.5 

ELSE 

IF 

A^'G 

LES  -0.6 

THEN 

0.6 

ELSE 

IF 

A.VG 

LES  -O.P 

then 

0.7 

Fl.SE 

IF 

AN'G 

LES  -0.2 

then 

0.8 

ELSE 

IF 

AFG 

LES  0.0 

THEN 

0.9 

ELSf^ 

IF 

ANG 

LES  0.2 

THEN 

0.0 

ELSE 

IF 

ANG 

LES  0.« 

THEN 

0.1 

ELSE 

IF 

ANG 

LES  0.6 

THEM 

0.2 

ELSE 

else 
end  s, 

IF 

ANG 

LES  0.8 

THEN 

0.5 

O.R  S, 

..  TEST  Of^'E  OAnGF  Cf<nSS  OVER  PROBLEM  // 
ecOP  s ffcnp  ♦ 1 $, 

RCCPU  s JfCnPi)  ♦ 1 ?, 

RCOPUT  s TOIOIT  •*.  UDIGIT  S, 

IF  (FIP55TTvr)  THEM 
BF.GIfJ 

PUPT  s RCOPUT  S, 

RAMGEO  B RCOPUT  * HDIGIT  $, 

Rh  r RAKjGEO  S* 

POLO  s OiNGEO  $» 

SIGNN  B 0.0  $, 

E'-iD  %, 

IF  ((PCCPU  GEO  3)  OP  (AeS(PCCPUT-PUPT)  LES  5.0/512.0)5  THEN 

RIjPT  B RCOPUT  $. 

»COPU  a 0 5# 

F.NO  S. 

parget  a HDIGIT  f PUPT  *. 

IF  ((SCOP  GEO  3)  OR  ( ABS ( P i NGET-R ANGEQ ) LES  50.0/512,0))  THEN 
BEGIN 

PAHGEO  b RANGET  %, 

PCCP  a 0 *» 

END  «, 

...  (>ME  PA'.’CE  U^E4B1?ATI0N  // 

//  ifcOl  a savGFO  - POLO  S, 

IF  ( ( AFO}  ) EOL  0.0  ) 

THEN  BEGIN 

RH  B RH  ♦ SIGNN«ABS(VHR#C0S(GAMM))  S. 

F NO 

Else  begin 

SIGNN  S SIGN(0. 0333333333, AEDl)  5, 

BH  8 bamgFC  ♦ 0.000R765625  - S I GN ( 0 . 0 0 0R765625 , AEO I ) S, 
POLO  a RAngEO  *, 

End  S, 

END  I, 

*•«*•//  PNG  I range  a PFFR(S)  *,  ...  TSINR  POSITION  // 

IF  NpDg  E,DL  1 Then  Rm  8 RANGE  J, 

PSIECPS  a C.5*P5IECPS  ...  FOR  SCALED  PROGRAM  s, 

PSIEhhOG  a O.S*PSIEMHOG  ...  FOR  SCALED  PROGRAM  $, 
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• • • 


4 DO  StLE.CT  . tT  ,r;e.5C0I0TG3  ( 5 S, 
, , . iDD  GOTO  I*  T T 
...  **•**//  OOTC  RFTUR^  5, 

, Em)  J' » 


IhJT.ofc'T  « Jf.TFCPllPT.cETUR'JCi  ?, 

S-ITC^*  s l-^'.E!.t.,',FLl^,FL>.,HLT,FLW  $, 

►lOTE  i‘j  i^rvE  S 4N'0  6 AWE  ILL. A AnO  U.L.0P»«  ANO  7 UMUSED  // 

*«««*//  r.rTo  (TKT.'JQ  + 1)  ■* » 

ADO  r-.T.‘.n  = T.O.S.  // 

ADD  ITE'^Pl  s CISCPETE,  IVPUT.wOWD  // 

AGO  GOTO  IMT.KJO)  // 


HLT  « STrWE.TOo.»)CWO,TnrLOC  GS.TOS)  s, 

GOTO  P-T.WET 

EL"  ’ E A TLuPE  . APvlMr.  ( ) t, 

GOTO  r«.T.WET  J, 


EM)  FIM 


SE'ITIE'EL  CARO  FOP  U-1108  TERMINAL 


♦ EOT  , * LATPO*-  . LiTPG“ 
BE G I'V 


...  the  FOlLO"IaG  is  the  lateral  PROGRAM  BLOCK// 


«****«**.  4 *****«****'*****i 


...  Global  variables  CCO-’-'O^  to  all  3 STACKS)  // 

PF4L  PvSTEmhdG.PSIECRS.xSINPhI  .KCOSPHI  , 

O'•,*-SI^R,‘^C^SP,TSI^^,TC^SR,SI^'PMI,COSPMI,RH,U0»TM,SDUM, 

i'SI^K,  JCOSR, 

SOil'^O  .PHI  f, 

Cry^C'-  G G'.Ttr.'', I ATST4C*',IA-TSTAC‘',0ISCRtTE, input,  WORD, FIRSTIME, 
"O.PFTFMHor,  ,PSIFCW5,k5Tk.PhI, KCOSPHI, CH.NSlSiW, 

PC  OSH,  TSI‘-y,  TCf'5R,'JSlNW,oCOS»,PPGS,Rr,S,QGS,XKCS, 

PPL  .RL.DI,  .yi'L  , V x PL  , C Du»’ , C OiiMG  , GSC OR T , 
SlNPHl,r.rSPHl,GLPl.BH.TM,sOUP,SOUPG,MOOE 
...  ♦**»*//  , CKPT, OH,  ,.h,vhG,GAHm,GH,  ATSw,vHTN,ATGSN  ,PHl,^AaLGS 
T, 

PFAL  ARPAV  GSSTACK tP9) .lATSTACK (QR)InTSTACK(99)  $, 
weal  awoav  oPGSMP),PG5n‘>),OGS(0),XXGS(a), 

FFL  n ")  , PL  ( 1 H ) , CL  ( j)  , XKL  ca)  . 

real  ap^av  Thl  a t ( 1 5 , t5GS  (3  ) , COb'' (U  ) , COU'-'G  («  ) $, 

INTEGER  oi*-,coF  TE  , P'PUT.^ORD  ?, 

INTEGER  MODE  S, 

POCLFan  GSCOPT,  FicsTr'E  j, 


•>U  1 


• • • 


****«//  prnuFftN  NftfsLGS 

PPF«ET  T^LAJd)  s C.97SI0«)9  J, 

PWESET  TPL4T(?)  s 0,P0U837a  $, 

...  T*>^F  FOLL^-^I^P.  variables  SwarE  SPACE  IN  BFFB  // 

...  Lift  = BFPP(ni,PSIFNHOG»PFFP(l),  ,,,,  T S I NRsBFF  R ( 8 ) » TCOSR»0FFR  ( 9 ) // 

SYNO^YPS  begin 

PSIENHOG  r Qy.  S, 

PSIECPS  s Z S» 

KSINPHI  B KSIN0‘<EGA  S, 

KCCiSPMl  s KCOSOPEGA  $, 

KSINPHI  B KSINONEGA  S, 

GM  B STCl,  TQM  S, 

HSINR  b hptw.inp  S, 

HCOSR  s VPTR.INP  S, 

ENO  $, 

POInTEP  CO^-POMENT  whole  S, 

whole  Sb«  0 

PPOCEPLiPF  OwORO.CUT.DIG.OUT  S» 

PROCEDURE  PTR.Fl.AG 

REAL  PPOCF.r.liPE  FOPINT,kalCLP,  <FIL1»  KF1L3  $, 

PEAL  PBOCED'iRE  SORT,  E*P»  ATAN8,  ATAN,  SIN»  COS  S» 

REAL  FRCCEOUAE  LINIT,SIGN  S, 

,,,  Hi,**,*//  bopi.ean  ckpt  $, 

...  ♦****//  PPOCEDURF  ASmOEC  J, 

,,,  **.**//  PROCEDURE  aS^FlO  S, 

...  **♦**//  PROCEDURE  PRT  S, 


«****//  REAL  C-H,ATSw.  VHTN,  ATGSN  S» 


SYNONYMS  lOPC  = LPSO.masK  S» 


...  LCCAI.  VARIACLES  (LOCAL  TO  THIS  STACK  ONLY)  // 
integer  LBS0,PASK,IT  $, 

Integer  flct.^-ooe, index  %, 
boolean  VE'RT.stp.FLAG,  itfst  s, 

real  wL .LC.RHIO ,ba ,ODB,CTw, VHG,QL02*RE,AY,OH,KY,6AMH, 

PSINO-, 

PhIlAG, 

HPhIC,RhICT,GAhe,PhOLO,XSIL,OumP,LAT.PH, 
GR,Ghw.,0V5TP,y?L.Y0T,YD,VPTR  S, 

REAL  Fw,CTE.-H,rH,SwH,CwH, aFDJ , AE02  ...  STACK  VARIABLES  i, 

...  preset  or  synonyms  nFFOEO  TO  OFFlNE  SFLF  TEST  C CONSTS  // 

...  ♦*♦*♦//  RFAi  COl ,C?,C3,CU,ftS,Cfe,C7,C8,C9,C10,Cll,Cl2,Cl3,ClR  S, 

PEAL  H.OfR.lNCH.OISPLACf'^ENT.VALUE, 

V.GTR. INCH, PI SPLACEME NT, value  $, 

®E*L  i-PTR  « , 

T-t  i-3''vF  m.ist  CC‘SYANT5  // 

,,,  *♦,►*•//  PPCCEOLiRE  output  S» 

,,,  *♦♦♦♦//  PPCCEOL'RE  HXPRT  S, 

,,,  «****««****««***«•«**«*««**************************************•**// 
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ku 


DEPIfvE  PBfiCEDlIRE  L^TPCM  TOPE 
BEGIN  ■ 

►»COE, control  *i 

PH  c GlBL.Rh  s,  SUFFER  TO  SAVE  GLOBAL  REFERENCE  // 

GOTO  ^ODE.SAlTCH(MnoE3  ?, 

SWITCH  HCOE.Sl^ITCH  b T acm  , S TM  , hhDGO  , I L 8H  , OFFND  S, 


MOnE.r'Tiex  s 7 %, 

GOTO  MAlM.cnf-PUTATION  %, 

»^00E  . 1 1 of  y s U 5# 

TT  = n 

GOTO  H K 0 « , 

ILS’-'S  IP  FIRSTIVt  THEN  BEGIN  ILS.IMTO  %, 

f^COt.  INDEX  c li  END  S» 

KF.CD‘'MOhO  ...  preparatory  calculations  S, 

ptr.flaG(  •'COE.  index,  lb,  13,  LOCFLAGO  ) 

IF  LOCFLACn  then  goto  H A I N . CONPUT  A T I ON  S, 

GOTO  LOC.S*1TCH(HOOE. index-3)  S, 

SWITCH  LOC, Switch  s hhsuBM,LOCAP,LOCTRK  s, 


mhsu«hi  ip  LOC. Hr  am, sensor. ETC  ()  THEN  MODE,  INDEX  a 5 S, 
GOTO  HATN.CGMpnTATION 

LOCAPj  IP  LOC.CAP.TO.TPAOKn  THEN  MODE, INDEX  a 6 

loctk-<-  goto  main.cc^putatidn  %, 


TAC-T  TP  PIpSTT“P  then  BEGIN  TAC.lNlTC)  S,  M0OE,TNDEXa«  5,  END  S, 

TAT  ,,,  preparatory  CALCULATIONS  $, 

?TP..fLAG(  •■ODE . INDEX,  IS,  l3,  TACFLAGO  ) 

IF  TACFLAGn  ThE'^'  GOTO  m A 1 M , C OMPUT  AT  I ON  S, 


GOTO  TaCSwITCh(KOCE. INDEX)  S, 

JxlTCH  TACSHITCH  a TAC0VS,TACAP,TACTRK,TACMH  $, 

TAC'-M'^  IF  TAC‘'H,td.CAP()  THEN  MODE. INDEX  a 2 f, 
goto  main. computation  S, 

TACAR«,  if  T ACAP,  to,  TRk  n then  mode. index  a 3 S, 
goto  ‘'AI^■, computation  s, 

TACOVSw  IF  OvS.TO.CARf)  Then  BEGIN  MODE, INDEX  a 2 S, 

...  //  AEDI  c pSIECPS  f, 

PSIECPS  a PSIECPS  ♦ PSINQU;  S, 

ISVSKP(  0. 0C^R7U2u31 6u  , 0 , R53662S0 1 9 , 1,0, 

0.000a?7<iA)98u77,  0.091986^872,  0 , 0 0 0 3 1 696972a3  , 
0.00Rfl678R3felb,  0 , 0002222222222  ) S, 

XXLfl)  3 TGm*rh  S, 

xxLf?)  = -'iC*SIN(  PSIECPS  )/0,957R3776l  1 S, 

XP'.  C YKLt?)  S, 

XWL(3)  S XWLfu)  = CTr.'  a 0,0  S, 

PSIFCP5  a GAMH  c xSIL  ■ *EOl  S, 

E-'O  «, 

GOTO  MA Iv, Computation  J, 


\ 

i 


293 


TiCT:;<*  Iff  TTc;-' .Trj,rvS(  ^ Tr<i-.‘v'  ‘^ODE,InOE5<  a i 5, 
GOTO  MAl*'.cn-iPUTAT  10^^  S', 


MAlM.C0^'P0T4Tin^$ 

...  **♦**//  IF  CKOT  TWE^  PPT(0,.C,  I W , C CMPlJT  A T I ON  /)$, 

r-OTO  f'CR- ITC^r^nDE.I^.'OEX) 

S^'ITCF  *^CS''ITC^  = TnvS“D»TCMD»TTKMp,MHF'D#t.C^O*LTKMD»STMD  S, 

OFFMi)?,  OIG.'-'IjTCQ.TPDE)  ...  VPTP  OUT  OF  VIEW  $, 

0TG.ni.TCF,T  = .;E5  ...  hptw  out  OF  VIE-J  X, 

OnTCi  tAT.-rT  F, 

ST«^05  <^Fi.F.TtsTn 

OUTPUT  (f; , V3T0)  I, 

OUTPUT n , M»TB)  J, 

GOTO  LAT.pp.T  S, 

MHMUi  ►‘A\.HDr,.cr."'PUTATTr'MfPSIE"'HOG)  s, 

GOTO  LiTFPiL.OUT  J, 

iCMD*  i.c APTu°r..co''pn 

GOTO  I ATEPAL  .OUT  %, 

LTWPO*  LTPACK , C0"D ( ) 

lateral. OUT«  Li.T.FlKlXU.CU^'^ONn  5, 

VFTF  c VPTP/0  , 1 5U9  5, 

OUTPUT fO,VPT=)  5, 

IF  ( IT  OCT  n ) Tr-EN  KFILH  PL,  PPL,  TRLAT,  OL, 

IR  ^OOE  f«l  I then  9H  else  1.0,  «L*  SOUM,  CDUM  J $, 

GOTO  I.AT.PFT  «, 

TC«0«  T AO APTUPF , CO^P n ?, 

GOTO  lateral  .OUT  , 

TOVS'-'Of  “A0,H0^,^,^,••PUTATI^^'(PS1ECRS)  X, 

GOTO  LATERAL. OUT  ^PTE  THIS  IS  HH  MODE  // 

GOTO  Taca'I'-TSH  S,  ...  MOTE  THIS  IS  HH  HODE  // 

TTK*'0<  tao.Tpace.CO^’PO  F, 

GOTO  lateral. OUT  S, 

LAT.PE7  * DONE  a TRUE  S, 

,-AlTLP  % 

...  **#**//  IF  C<PT  then  PRT(0,,C,  /WAITLP/)  S, 

STSL'PO  r. 

...  ADP  IF  00^E  THF^J  GO  TC  aAITLP  ?, 

...  ***«  //  on  TO  NOOE. CONTROL  S, 

E^D  ..  OF  lateral  procedure  DEFINITION  i, 


i 


DEFINE  ppoCFOURE  PTP.FLAGf  P.^nOE,  P.FLAG,  FLAG,  CONO  ) 

O.HEPE  Integer  p.vooe,  p.flag,  flag  boolean  cond 

TObE  ^EGI'" 

IF  ( 3. “ODE  NED  1 OR  U ) THEN  FLAG  a FLAG  OR  P.FLAG  S, 
DIG.O'.iTt  flag,  CONO  ) $, 

EvO  *, 


DEFI-mE  PROCFCURE  HAN.HOG.COMPlJTATIONfAEDl ) 
WHERE  real  AEOl  TCBE 
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y E G I '>< 


****«// 

// 

// 

//  WEil.  S 


f.flQ 


If-  C^f^T  T^F^  P»T(0,.C.  /MAN,Hnc:,CO''P/)  S» 

r.HM  s a'0-o,3y7<j?yy7)/o,  537  i«?8y?  s» 

G•^H  r LJ^ITCn.  JJ-i3333333,GHH)  ♦ 0,66666666667  Si 
AEG?  = 0,16666^7,  AEOl  ) $, 

PmIC  r r,MW*AFO?/(  -0.3333333553  ) $» 

OIG.nUT  (8,E4LSE0  ...  HPTR  out  of  ViEtN  BIT  S, 

OIG.OUTCR.TPUE)  ...  VPTP  IN  VIEW  $, 

5, 


OEFl^'c  OPOCEOIIBE  ILS.INIT  TOBE 
BEGIm 

*****//  !>>'  Ci<PT  THEN  PPT(0,.C,  /ILS.INIT/)  S, 

Ri  s RM  s 0,15625  S, 

AV  3 0.1  «, 

L A T . p!  I T O 5 , 

I..C  a 0,37136  S, 

ISVSKP(  O.0RB30U,  0.000000375,  0.0065536, 

0.000000  023B«lB,  0 . 0 1 1 03<»5325  , 0 . 000  1 0^67  1 7<?52 
0.00003^1  7558372,  0 . 0 1 a222222?2  ) J , 

t E N 0 ? , 


Twps  procedure  is  a SAVE-SKlP  TYPE  // 

OEPINE  PPOCFGnPE  LAT.ImIT  TOBE 
BEGIN 

**•**//  IF  n^PT  ThFn  pfT(0,,C.  /LAT.INIT/)  S/ 

KALCLP  C YKl.,Pi,  ) s, 

Pi  = 0.0  T, 

IT  = 0 «, 

Oti  3 G («'  » , 

C T ^ = 0.0  $ , 

VHG  s UO  < . 

r.  t""-  = PSIECPS  %, 

Rt-OLO  5 PHI  ,,,  IC  BANK  RATE  COMp,  // 

rHTuaG  b 0,0  5, 

END  T, 


THIS  PPOCEOUPF  IS  4 SAVE-SKIP  TYPE  // 

define  PS.'CEOlIRE  ISVSKP(a,B,C,D,E,F,G,H) 
a-F.oE  real  a,H,C,D,E,F,G.h  TGBE 
BEGIN 

*♦•*■*//  IF  CKPT  ThFn  PPT(0,.C,  /ISVSKP/)  f, 

Pim  » A 5, 

PI  f6)  a B t, 

PL (1 n = C F , 

PI.  (16)  c n 5, 

GLO?  = E 3, 

GL(5)  a A 3, 
r.i(u)  e G « , 

TRL4T  (3)  « H f , 

END  3, 


PEFI^E  PPOCEOUPE  ILS.CO^^^ON  TOBE 
BEGI^ 

...  IP  CKPT  Them  ppt(o,.c.  /ils, common/)  %, 

IP  C IT  LES  1 ) THEN 
BEGIN 

xKun  B OM  $, 

XKL (?)s-0.uu500*U0*SIN(PSIECRS-0,03125*OM)/RH  $, 

ENO  %, 

IF  ABS(GH)  LEO  0.639999U 

THEN  RA  B 0.Ui*300*VHG*SlN(0.03l25*OH-GAMH)/ClDB  S, 
PE  s RH  - 0 . OOOB<J5*VHG*C08  (GAmh)  $, 

...  RANGE  rate  filter  , .(RANGE  ESTIMATE)  // 

...  //  real  RD  %,  RO  s RA  - PE  S, 

IF  ( AR8(0H)  LT  0,1772950  AND  MDOE, INDEX 
NEQ  a ) THEM  AY  a 0.95*AY  S, 

PH  a PE  ♦ Ay*LIMIT(0.0625,RD)  S, 

IP  GSCORT 

THEN  PH  a PE  + 0.1*(  SH  - RE  ♦ O,Ofctt3O280  ) 

ELSE  IF  RH  LEO  0,15625  THEN  RH  a 0.15625  S, 

GLBL.Rh  a RH  S, 

LAT,COmmON(PH, 1 ,0,OM,-0,0  3«56,0.0  059U5,0. 18332, 1 ,0)  S> 

LAT  RR7  // 

!!!  //  * KY  a 0.1029506135/(0,  1 10671558  + 0. 889328<mi9<t 

ABS(OH))  $, 

PHICT  a (KY+Oh  + QOB)/0,6873275UU3  $, 

END  S, 


...  this  PpuCEOURE  is  a SAvE-SKiP  TYPE  // 

DEFINE  PPOCPf^URE  LAT,C0mm0N(  RHJ,  RH2,  SOM.  KFK,  KCTE, 
KSCALl,  MCCAL2  ) K.HERE  REAL  RhI,  RH2,  KFK,  KCTE» 
KSCALl,  •'■SCAL2,  DOM,  SQM,  CNH,  SwH,  S, 

TOBE 

BEGIN 

...  ***♦*//  IF  CKPT  THEN  RRT(0,,C.  /L A T , C QmmdN/ ) S, 

PHILAG  a 0.99R5*(  PhRAG  - PMI  ) + PHI 
PHRAG  a LINIT(  0.00060937,  PHRAG  ) $, 

Phi  a Phi  - PHRAG  ?, 

SINPHI  a SIN(  PHI  ) S, 

COSPHI  a COSC  PHI  ) *, 

3LC2)  a IF  IT  LES  25  THEN  QL02 

ELSE  0.00025*QL02  S, 
...  QL(2)  IS  DOUBLE  PRECISION  // 

IF  (IT  GRT  0)  THEN  BEGIN 

H a PH?  %,  ,,,  OnuSLE  CONVERSION  // 

ZK  a SO“  S,  ...  double  CONVERSION  // 

FK  a kfk*sINPh1*C0S(GAmH)/(Rhi*C0SPHI)  s, 
KFR2(TRLAT,XKL,H,ZK,FK,S0U‘SCDUM)  S, 

END  S, 

IF  CKPT  THEN  BEGIN 

‘'XPRTC.C.  / PL  matrix/,  PL, 16)  8, 
MXPPT(.C.  / XK  matrix/, XKL,  U)  i, 

END  S, 

%,  QHO  c OH  «,  ...  buffer  old  VALUE  // 

Qh  a XKL(1)/Ph2  S, 


...  LC«N.aR\  // 


KALhN? 


. • • / / 


«***«// 

***•*// 

•*♦•*// 

**•*•// 

//  hpr  oho 
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// 


F.Q7^G|i 


• • • f f 

. . . // 

...  // 


. . . f f 
...  // 

...  // 


TC  ‘i  t <fc, 

5 « 0 . ofloey5*sp^/PHI/(v^-G*cosPHl ) s, 

Cf£  a Cr.*(  CrO  -&►")-  <CTE*VHG*S1M(0AME;)  %, 
CTP  & LI^TT(O.05lO2eS7*KCTE,CTE)  S, 

CT>.  B IF  (•■'CDt.  If'DtX  E2L  «) 

ThE^.  0.0 

ELSE  (CTw  4 CTE/LC)  S, 
a 48S(CTis)  «, 

OH  s SIG^f0.5,CT«.)  %, 

C*H  s V H*C0S {QH-PSIECes J %, 

SWM  = tO^-'’5IEC»S)  S, 

AFoi  = UO  * $. 

VHG  B SGPT(  $xw*SwH  4 F£Dl*AEDl  ) ?» 

Gi«H  n PSTECSS  ♦ A T A N 8 ( S xw- , A E 0 1)  S » 

AEDl  B KSriL?*VHG*VHG*(0,5-0,5*CDS{GAMH))  5. 

A E 0 1 a - s I G ^ ( A E D 1 , G A M H 3 5 . 

AED?  s KSf:Au3«PH*AhS(0H)  s, 

PHICL  B ATA\3(AE01 ,AE02)  5/ 


I 


fi 

fi 


P 


'i 


. . . 


. . . 


T» 


• • • 
• • • 
• • • 


L''EFI^!E  f'l^CLEAK  PPOCEOUPE  uOC  . BE  A^» . SENSOP  , ETC  TOBE 

BEGJ^ 

*****//  l^  CKPT  Ti"EM  PPT(0,.C.  /LOC. beam, SENSOR, ETC/)  S. 

LDC.BFam. SENSOR, ETC  s FALSE  i, 

IF  DISCRETE, I''^PlJT.xORD  .A,  UB80.>-ASK  NEQ  0 THEN  GOTO  TR  S, 

LAT.f’KlC  // 

PL  B 0.0  S, 

IF  (Aes(OH3  G»T  0.5686685)  THEN  BEGIN 
IT  s 0 $, 

CT'X  a 0.0  S, 

»H  a 0.15625  S» 

GOTO  RETURN  $, 

FJ>.0  %, 

RL  e 0.0000163e«  5, 

IF  (IT  !.ES  30)  then,  begin  IT  e JT  ♦ ! S,. 

GOTO  RETURN  ?, 

END  S, 

PL  a 0.000  1 638^1  S . 

IF  (P'<  r,PT  0.3125)  AND  (ARS(OH)  GRT  0.«26666666)  OR 
(Rh  LF'j  0,31?5)  and  (APS(Qh)  GRT  0 , 5668  685-0  , U5509  0 U *RH ) 
THfNi  goto  PETUPN  S» 

IF  ( 0.07  3 1 1 1 1 GRT  AHSCCI^)  ) T^EN  GOTO  TR  %, 

IF  ( fBSfPHlCL)  LES  (O.Ollllim  ♦ 0,0625*ABS(QH)  )) 

Them  goto  return 


3 

LDC  , BF.  ah.  SENSOR. ETC  a 
K'ABLC-S  a T»UF  S, 

»L  a 0.0001636U  S, 

IT  a 30 

TRUE  %, 

• tlN‘"  ASK 

TiHfP?  j.ifE.ROuPT  // 

AO'I 

Dump  a TRIBCINT.NO)  S, 

ADO 

WOCMSK.REG)  3 ( T?«ASK  ,V, 
END  a. 

HO(MSK.REG))  $, 

define  procedure  L C A P T URE , C OMP  TOBE 
BEGIN 
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I 


*♦»**//  If  CXPT  OBT(C,,C.  /LCAP7U»F.,CCHP/)  5, 

PHJC  a PKICL  %, 

E'-'P  $, 


OEFl‘.e  t^nOLEiNi  PBOCEPUPE  LOC,C*P,TO,TP*CK  TOBE 
BEGIN 

****•//  IF  CKPT  ThFn  POT(0,,C.  /LOC.CAP.TO.PPFTRK/)  S« 

IP  ( ( 0,07Ulin  G«T  ABSfQH)  ) PR 
( P.106bt;F«,  r.BT  iPSCrjM)  A^D  O.numa  GRT  iBStGi^NH)  ) 
OR  ( -C.lOBfcafrS  GRT  GH  AND  GAmh  g»T  0.11111112  ) 

OP  ( Gn  gpT  O,i06bUfeB  and  -0,1111112  GRT  GAMm  ) ) 

T P E G rj  E G I ti 

LOG, CAP. TP. TRACK  a T»bE  i, 
hPHiC  a PMIC  - PhICT  I, 

PL  a O.OOlfeSfiU  S, 

END 

ELSE  LOC. CAP, TC, TRACK  s FALSE  S, 

F.NO  5, 


CEFIME  PROCF.OUPF.  LTRACK.CO^P  TOBE 
BEGIN 

***#*//  IF  CKPT  THFN  P»TfO,,C.  /LPRETRK.COPP/)  f, 

Ay  a 0,BB2«RbQ02b**y  %, 

PhIC  a HPMIC  + P>^ICT  f, 

HPHIC  a O.RF'jt'-PHIC  S, 

IF  RH  LEQ  O.lBfeZS  then  PHK.  « RH*PhIC/0 . 15b25  I, 
END  S, 


DFFINf  PRCCEOL'PE  L A T . F I N 1 SH , C Ohmpn  T08E 
B E G I 

***•*//  IF  CKPT  THFN  PPT(0,,C,  /L A T . F I N I SH , COhhQN/ I $, 

//  RE’.L  PHlI  «,  PHII  a PHIC  - PROUD  «, 

PHIC  a PhtlO  ♦ LIHITCO. 00277757, PHin  S» 

PhIC  a LlHlT(0.1b870P2,PHlC)  S» 

PHPLO  a PHIC  S, 

VPTR  a PHIC  - PHI  %, 

End  5, 


DEFINE  PROCEDURE  TAC.INIT  TOBE 
BEGIN 

^»****//  IF  CKPT  then  pRTC0»,C.  /TAC.INIT/)  S, 

LAT.IMTM  ?, 

RL  a 0.0305175  S, 

PS  INpw  a G*hh  f , 

OH  s TGM  «, 

LC  a 0.2321  «, 

ISVSKPf  0.002R7a2a31bP,  0 . R55bS250  1 9 , 1.0, 

0,000U?7aHRBa77,  0 . BP  1 RAfcuA 7p  , 0 . 0 0 0 3 1 6 R 697 2U 3 , 
O.O0P0678a36l5,  0 . 0002222222222  ) ?, 


• • • 
• • • 


• « • 


• • « 


• f « 


• • • 
• • f 


T»U 


E.^D  5, 


DEPIKE  PROCEDURE  T^C.COm^'OK  TOBE 
BEGIN 

*«***//  IP  CKPT  TWEN  PRT(0,.C,  /T^C .COMMON/)  S, 

T4C.R91  //  IP  ( IT  LEB  1 ) THEN 
BEGIN 

5<«Lm  a TQ»^*»M  %, 

X*<L(2)  = -U0#SIN(PSIECRS)/0.957PJ7761  1 S. 

XEL  = y<L(2)  5, 

XEIL  a G*MH  5» 

END  %, 

TAC.MR^  //  LAT.CO^^^-ONfi.o, PH, TQM, .0,08332B7Ba58, 0,0002321  , 

1.0,  0.190803125  ) S, 

GP  a 0 ,0P7h58?5/RH  // 

IF  CRH  LES  0.09765825)  THEN  G»  a 1.0 

ELSE  GP  = 0,09765625/RH  $, 

OVSTO  s 0.032P1?5*UO  $, 

XcL  a 0.9fl0m59*(  X2L  - X<L(2)  ) XKLI2)  S, 

...  1ST  t^ORO  OF  XKLC2)  // 

XSIL  c 0,960ia5u*(  XSIL  - GAMH  ) ♦ GAMH  $, 
yOT  c 'X2L  «■  VHG*(GAMH  - XS  1 L ) /O  . 3 0 U 76 1 90^7  #, 

PHICT  a GP*(XKL(n+0.192*VDT)/0.3560985  $, 

END  %, 


DEFINE  boolean  OPOCEDUPE  TACMH.TO.CAP  TOPE 
BEGIN 

peal  ahjpkl  S, 

****«//  IP  CPPT  Tt^PNj  PRT(0,,C,  /TAOMM.TO.CAP/)  $, 

IP  DISCRETE . INPUT . ^OPD  .A.  LBSO.maSK  N£0  0 
then  goto  TRU  %, 

TiC''H,  TO.C  AP  c false  S, 

TAC.iP',  //  IP  ; (RH,ARS(TQy)  CRT  0 , C 99  a 7 1 (?  30  ^ 

and  (IT  LES  n ) THEN  GOTO  RETURN  S, 

IP  (IT  LES  30  ) 

THEN  BEGIN 

IT  s IT  * 1 S, 

GOTO  RETURN  $, 

END  S, 

TAC.BRHA  // 

//  ADJphl  s 0.35  + LIMITCO. IS, (RH-0.136725)/0. 52063)  I, 

IP  ( (PHICL*PhICT  LES  0.0)  OR  (ABS(PHICT)  LE8 
A6S(PHICL*ADJPhl) ) ) OR 
( (AaS(PHlCT)  GRT  0.00555769)  AND 
(ARS(OH)  LES  0.0666689  ) ) THEN 

GOTO  RETURN  S, 

.?  TACMH.TO.CAP  B TRUE  %, 

CT>v  = 0.0  E. 

IT  s 30  $, 

EnO  $, 


OEPINE  PROCEDURE  7 AC  aptliRE  . CDMP  TOBE 
BEGIN 


IF 


Ckpt  then  PhT (0 , ,C  . 


/TACAPTuRE.COmp/) 


2P'^ 


. . . 


**««*// 


PI  a O.CJ05175  S, 

PSINO^  a PSIECBS  S, 

IF  (APS(PHICL)  LES  ABS(PHICT))  AK'D 

( 0,0  6P  RH*PWICT  ) 

THEN  BEGIN 

PHIC  a PWICL  %, 

ITEST  « TRUE  S, 

END 

ELSE  BEGIN 

PHIC  a PHICT  i, 

ITEST  a false  S, 

END  i, 

END  %, 


• • • 
• • • 


• • • 


DEFINE  BOOLEAN  PROCEDURE  TACAP.TO.TRK  TOBE 
«****//  BEGIN 

t****//  IF  CKPT  THEN  PPT(0,,C,  /TACAP.TO.TRK/) 

TACAP.TO.TRK  3 

(NOT  ITEST)  ANO  (APS(QH)  LEG  0,0888889  ) 
****«//  EnO  $. 


s, 


DEFINE 

,,,  ***«*// 

...  *<**♦// 


, , , *****// 


PROCEOUPF  TAC, TRACK, COMP  TOBE 
BEGIN 

IF  CKPT  THEN  PRT(0,.C.  /TAC, TRACK, COMP/)  %, 

PHIC  a PHICT  S, 

PL  * LlMinO,  1S25876906»0,78125*PH)  %, 

PSJNOW  a 0,90ae37ai*(  PSINOH-PSIECBS  ) 4 PSIECR3  S, 
END  S, 


• • ■ 

• 9 • 

• • t 


define 

*«***// 

*****// 

*♦***// 


boolean  PROCEDURE  OVS.TO.CAP  TOBE 
HEGIN 

IF  CKPT  THEN  PPT(0,,C,  /OVS.TO.CAP/)  $, 
OVS.TO.CAP  a RH  GEO  0V8TP  $, 

END  $, 


• • • 
• • • 

• ■ 9 


DEFINE  boolean  procedure  TTRK.TO.OVS  TOBE 


*A***//  PEGI^J 

*♦*♦★//  IP  CKPT  THEN  PBT(0,.C.  /TTRK.TO.OVS/) 

TTRK.TO.OVS  a RM  lES  OVSTP  S» 

♦***♦//  EnO  $# 


s, 


1 DEFINE  boolean 

PROCFOURE 

TACFLAG  TOBE 

1 TACFlAG  3 

(DISCRETE. 

INPUT, WORD  .A, 

200C) 

NEO  0 S, 

OEFINE  boolean 

PROCEDURE 

LOCPLAG  TOBE 

LOCFLAG  a 

(DISCRETE. 

INPUT, WORD  ,A, 

«00C) 

NED  0 Sr 
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DEFINE  PSOCFDL'PF  F A I L U^E  , w A PM  TOBE 
PEPIN  DK-.CUT(10,TPI'EI  ?» 
OIG.GUT(U,TPUE5 
OIG.nUT(15,TPUE)  $, 

End  %, 


SYNOf,Y--S  begin 

51  iiE-BC  = COl  *, 
c c?  <s, 

.“75  n C5 

= CJ  ?, 

Aif'OOlC  S r.F  .5, 

= cn 

.CO^PB  = Cl? 

, 0 ? R = Cl?  * , 
.rohP?  5 cu  S-, 
.5  S C7  «, 

.1  = CF  $, 

ENC  >, 


DEPINF  PPPCE'VJPE  STSU9  TGBF  BEGIN 

IF  ((fOUC?I/C3)*C<J-C5  NEQ  C6  THEN  F A I LURE  , ^ ARN I nG  ()  S* 
GHTf,  s?ETi'KN'  S, 

FAlLUPE.KARNINGn  S, 

END  $, 


DEFINE  PPCCEDijPE  SELF, TEST  TOPE 
EiEGiN 

IF  not  FIPSTIPf;  then  BEGIN 

IF  AeSfVPTK, INP-Cl n GRT  Cl?  THEN  FLCT  c FLCTtl  *, 

IF  ABS(HPTR,p!P-C13)  GRT  Clu  THEN  FLCT  a FLCT+1  $, 

END  ELSE  FLCT  a 0 «, 

IF  AFSf  STCl  -C7)  GRT  Cfl  THEN  FLCT  =FlCT+1 

MPTP  a H. DTP. INCH. DISPLACE"ENT, value  S, 

VPTR  s V.  T*- CH,  DI  FPL  ACE'^ENT.  value  S, 

IF  FLCT  GPT  b then  F ailUPE,^ABNING(5  $, 
end  T, 


fc.NO  fim 

SENTINEL,  CAPO  FOR  U-llOB  TERMINAL 

>JFn  afD,*  OFDPG'-' , OFCOG^" 

BEGIN 


...  the  FQLLCiNlf.r.  IS  the  GLIOESLOPE  PRCGPAH  BLOCK  // 


**♦♦•******♦*♦**********'*****(►♦♦***********1 


...  global  VARIAolES  (C0»"‘-CN  to  all  3 ST4CKS1  // 

oEAL  PSIEMHPG,F5IECRS,‘'SINRHl,KCr'SPHl,QM,HSlNR,MCCSR,TSlNR, 


USINR.IJCOSO. 

TCnss.SU'f'Hl  .COSPHI  ,KH,UO,TM,SOUM,SDUMG,PHI  s« 

REAL  OLO? 


C0•^^‘0^■  GSSTAC*<,LATSTAC*< , I i^T  ST  AC  K » DI SCRE  TE  , I K'PUT  , WORD , F I RST I HE  » 
'J0#GH,7,KSlNOHtPA,KC0SnMpGS,CH,HSINR,HCP8R. 

TSJNR,  TCr,«P,uSI^R,UC^SR,PPGS,PGS,QGS,  XKGS, 

PPL,PL,GI.  ,XKL.  VKPl*CDUH.COL;hg,GSCORT, 

SI^PHI  ,COSPHI  ,i.H,IjO,Tm,SDUH,SDUMG,MODE, 

s. 

PFAL  ARPAV  GSSTACK(qP),LATSTACK(RR)lNTSTACK(99)  $, 

. ***♦*//  ,C<PT,CiH,WH,VHr,  ,GAMH,GH»  ATSW,VhT^»ATGSN  ,PHI,NAPLGS 

real  array  PPGSn^i)  ,PRSn63 ,0GS(U)  ,YKGS(«)  , 
PPL(lt>)»PLn8),r:L(«).XKL(9)  s, 
peal  array  TRLATf^),TPr>S(3),C0U^'.(«),C0UMG(«)  S, 
iNTEGfP  DISCRETE,  IMPljT.txCRD  S, 

ImTEGER  •'"Of'E  ?, 

•iOOLEAv  GSCPRT,  FIpsTIHE  % , 

,,,  ***♦*//  t<r.oiEAM  NARLGS  S. 

Pffc'SET  TRl.ATfn  = 0,97S3CPR  f» 

PRESET  TRLAT(?^  s O.ROuft^TU  S, 

PRESET  TPr,S(?)  x 0 , 1 «i?22??2??22 


...  TWF  POLL^AI^^,  VAPlAftLES  SmaRE  SPACE  IM  8FFR  // 

...  UO  B r*FPPfO),PSlE*^HDG«PFFPn),  ,,,,  TS I NRsBFFR  ( 8 ) , TCOSRbBFFR  ( 9 ) // 


SY'.QNY“S  HFGlM 

PSIEhhOG  a 
PStECPS  a 
KSIWPHI  a 
KCOSPhI  a 
KSINPHI  a 

CM  - 

HSIMP  X 
ViCOSP  a 
END  S, 


GH  S, 

z s, 

KSl^iOHFGA  i, 
KCOSO“EGA  S, 
KSI^O“EGA  S, 
STCl.  TCH  s, 
MPTP.IMP 
VPTR.INP  %, 


« « i 
• • • 
• • • 
• • « 


PPT>‘'TEP  CO'-'PCAiEMT  whole  S> 

-hCLE  *st  0 T, 

PPOCFOl'RF  PTP.FLAG 

peal  PPCCFCi'KE  FCPIM.kaLCLR.  KElLl.  KFIL2  S, 
procedure  ■"'wnRn.CliiT.DIG.OUT 

BEAL  PPOCEOijRf  SCBT,  EXP.  ATAN6,  ATAN,  SlH,  COS 
peal  PROCECl.'PE  LI“IT,SIGN  S, 

*«***//  POCLFam  CKPT  5, 

**•«*//  PPCCF.DUPE  ASmofc  5, 

***«*//  PPOCEDURE  ASmflO  S« 

»****//  PBDCEDURE  PRT  5/ 


S. 


// 


...  I.OCAI.  vabIAHLES  (LOCAL  TO  THIS  STACK  C!^LV)  // 

...  ****•//  RFAL  Rh.wh.VHG.GAMH  %, 

peal  UFI ,UF2,TC,HPTR,TDC , atsw, VHTN, ATGSN.GDH.TFl ,TF15,TOM,sho, 


I 


i 


1 


1 
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J 


GH0,T‘^15C,TnCM  ,GDF  5, 

REAL  Gh  S, 

OEiL  FKG«i,TDCt  ,TDC6v  ...  STACK  VARIABLES  ONLY  *, 
INTEGER  V^sn.^iASK  «, 

INTEGER  GS.TNOF.y,  GS.IT  S, 

FG  IS  DOJ«LE  dpecisION  // 

PEAL  array  PG(?5  j, 

PRESET  RGft)  5 0.00O00007Sl?S  $, 

PRESET  PG(?5  = 0.00000'^156?5  $, 

PRESET  RG(3)  = 0.0000031P5  $, 

PRESET  TRGSCn  = 0,ftP76?ii5E  ...  EyP(-.025i 
PRESET  TRGS(25  s 0,nPSin?5  ...  EXP(-,05)  $, 

PRESET  TRGSC-S)  = 0 . 0 1 


DEFINE  PROCEDURE  GSPG^  TOBE 

BEGIN 

ILSAPP  $ PTR.FLAGC  GS, index  10,  0,  R.ALT.FLAGH  ) $, 

...  RADAR  altitude  VALID  S, 
PTR.FlAGC  GS. index,  lu,  12,  GSFLAGO  ) 

IE  GSPLAGO  THEM  GOTO  m A I N , C0‘-PUT  A T I ON  S, 

GOTO  OSS-ITCMfOS, INDEX)  %, 

SXlTCh  GSS-aTCH  = GSPC  , GSC  A P , GSTRK  , GS I DL  S, 


GSIOU5 
6SCAP  « 

GSPC  % 
GSTRk? 


GSTESTO  t,  GOTO  M A I N . CONPUT  A T I ON  $,  | 

IP  GS.C.TO.TRKf)  THtN  G3. INDEX  a 3 S,  j 

GOTO  GSTRK  S, 

IF  GS.P.TC.CAPO  then  begin  GS, INDEX  r2  5,  GSCORTaTRUE  S,  J 

TC  5 S,  i 

DIG.OhT (1 1 ,PAlSE)  ...  GPENGA6E  %,  ] 

DTG,0'jT(B,F  ALSE)  ...  PPTR  IN  vltW  $,  END  i, 

GS.CO“>'ON(  ) 5,  GOTO  P A I n , C OMPU  T A T I ON  S,  i 


HAlN.CQPPtJTATICN? 

SWITCH  GS.rOPP, SWITCH  a GSPCpD , GSCMD , GSTKMD , GS . RET  S, 

GOTO  G5.CO-''P.SwITCM(GS, INDEX)  S, 

GSC*'DS  GS.CAP,Cn''P  ( ) f , 

GOTO  GSFIntSh  I, 

GS°CHO«  GS.PRECAo.COPPC)  T, 

GOTO  GSFImISh  S. 

GSTRMrs  GS.  track. CONPO  T, 

GSElNlSH? 

HPTR  t HPTR/0.l5R15‘i9  S» 

OUTPi.iTf  1,  HPTR  ) 5, 

KFILl (OGS,PPGS,TRGS,QGS, I • 0 » RG t GS , I NOE  X ) , SOUMG  , CDUNG ) I, 
G5.RET  ? DONA  3 TRUE  •* 

...  add  malt  S, 

END  ...  OF  G?  PPOC  %, 


10  1 


1 


otFiME  vpncEnuse  rstest  tore 

IF  G^'  LES  0.39fi822?2?2??2 
then  begin  GS.INOEX  b 1 
GS.INTTO  $, 

ENO 


AND  NABLC8 
i, 


II 


define  opnrpnijtJE  GS.IMT  TOSE 
begin 

***«*//  IF  CKPT  then  PbT(0,,C.  /OS.INIT/)  t, 

G5.IT  SOT,  ? 

RH  S r.M  T,  j 

SH  3 rt,ii5^^6,,2S*Z/(  0,bU  m O.J(i*GH  ) S,  \ 

GDH  s -0,3b55‘590099*ij0*SIN(ATCSNBO,Ol3e868e8a7  + 

TH  n/5H  «, 

VHTN  s UFl  s UO  I, 

ATSN  s UF?  a 0,0  S, 

GOF  s GDH  $, 

TFJ  3 TP15  B T*^  f, 

kALCLR(XKGS.PGS)  $, 

PGSfn  * 0,l090t)fi8  f,  I 

PGS(6)  s 0.01576051757  S,  j 

Pf-Sni)  E 0,1090688  %, 

PGS(16)  s 0,000155507a56U  S,  i 

0GS(2)  3 0,0002328757^91  %,  I 

DGS(35  ■ 0,0006379<i29  $, 

OGS(u)  8 0,002529766367  %,  | 

XEGSd)  s 0,2S*GH  J,  “ 

XKGS(2)  s GOH  T,  j 

End  S,  I 


DEFINE  tff'ncEDOPE  GS,CO»>HON  TOBE 
HEGIN 


t • • 
• • • 


****•// 

GS.R03  // 


//  peal  UFlC  3, 
//  PF.AL  S«0  5, 


IF  ctfPT  then  PBT(0,,C,  /GS, common/)  %, 

If  GSCOPT  Then  Al5s0. 99335555  ELSE  A 1 SsO , 909  8379  $, 
TF15  B A1E#(TF15-TM)4TH  %, 

TT15C  B TH  - TF15  S* 

-JFI  E 0,98920*(  UFl  • UO  ) ♦ UO  S* 

UFlC  a UO  - ilFl  $, 

i'F2  s 0.9«9210988*(  uF2  • uFlC  ) ♦ UFlC  S» 

SHO  a SH  «, 

SH  s 0,9*Sh  • 0.00065625aVHTN*COS(ATGSN)  ♦ 
0.0415836625*2/ ( 0,69  • fl,36*GH  ) S, 

IF  ( 0,0  GPT  SH  ) THEN  Sh  b 0,0  5, 

TFl  s 0,90U8379*(  TFl  • TM  ) ♦ TM  S, 


• • • 
• • • 
• • • 


// 

//  REAL  ATGSE 
// 


TOM  3 Ty-TFl  T, 


// 


if  ATGSE  B ATGSN  * 0,l*TOM  S, 

AEOl  s SH  - SHO  ♦ 0,000695*VHTN*COS(AT68E)  S, 
ATSW  B ATSH  • AEPl  $, 

VhTN  s Ul  ♦ ATSh  i, 

IF  ( 1 GPT  G3.1T  ) THEN  GOTO  G8.8R9  S, 

FK  8 -vhtnfTD^/IO,  1733756*Sh)  *, 

...  fk  is  local,  double  // 


3D4 


p 


•^,1^ 


GS.tiCC  \ 

, , , *«**«// 
, , , *«*•*// 
, , , ***♦*// 

,,,  **«**// 


•-  = 1.0  ...  H IS  LOCAL,  DOUBLE  // 

z><  = ...  ZK  IS  local,  double  // 

KFIL2(TKGS,XKi;s,H.ZK,FK,SOUMG,CDUMG)  5, 

GS.IT  s 1 

IF  CKPT  THLN  BEGIN 

^^XPOT(.C.  / PGS  »^ATRIX/,PGS,  16)  %, 
»ri<PWT(.C.  / XK5S  MATRIX/,  XKGS,  41)  S, 

END  T, 

GH  e XKGSn)/0.2B  S, 

GDM  = XKGSf?) 

sf'F  = 0.0«(  r.DF  - GDh  ) + GOH  5, 

ATLSr-  e -0 . 60Rb?3809b*GOF*SH/VHTN  S, 

END  S, 


D'PI'E  “nCCEL'iJRb  GS.  pRFCAF',cn''P  TORE 
- £ w I ' 

...  .♦♦**//  TP  CKPT  Th-E-.  PF'T(0,.C.  /GS.PRECAP.COHP/I  5, 

I'TG.CuT  («,  TPUE5  ...  HPTR  OUT  OF  VIEW  BIT  S, 

F.  ^'0  5, 


DEFINE  boolean  procedure  GS.P.TO.CAP  TORE 
begin 

...  ★**•*//  IF  CKPT  then  PPT(0,,r..  /GA.P.TO.CAP/)  $, 

GS.P.TO.CAP  s GH  LEQ  0.1RPU03J 

OF  discrete. Input. WORD  .A.  VaSO.PASK  NEQ  0 i, 

end  S, 


define  procedure  GS.CAP.C0"P  T08E 
BEGIN 

IE  CKPT  T>-EN  pptco,.c.  /GS.CAP.CO^^P/)  S, 

TDC  a -0 . 0231  iJ*V^^TN*  ( 0.5  - 0 . 5<>C0S  C ATGSN)  )/ 
Sir,N(  SP*r,ri,  ATGSN  ) S, 

Tc  3 Tc  ♦ TOC  ?,  ...  Integrate  theta  dot  // 

HPTR  a (TC  - TH)/0.25  - IJF2/0 , 1 869P956  S, 

END  S, 


• ■ • 
• • • 


// 


DEFINE  boolean  procedure  GS.C.TO.TRK  T08E 
BEGIN 

...  A****//  IF  CKPT  Tmen  PRT(0,.C.  /GS.C.TO.TRK/)  $, 

IF  ( GH  lEO  0.0813773  ) T^En 
begin  GS.C.TO.TRK  a TRUE  S, 

...  //  TDCA  =T0CA.SU8()  S, 

TOCAT  a HPTR  - TDCA  S, 

END 

ELSE  GS.C.TO.TRK  a FALSE  S, 

END  «. 


...  this  procedure  is  a SAVE-SKIo  TYPE  // 

define  meal  PROCEDURE  TDCA.SUS  T08E 
BEGIN 
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...  //  TOCAV  c n ,0~v>aK</0,«2aS7ia)*GH/0, 3775597  %, 

...  //  TDCAV  * TDCAV  4 

(O.8>^3279a*GOw4.0,UUlfe39a*GDF)/VHTN  S> 
, TDCA.SUB  ■ TOCAV*SH  • TF'lSC  $, 

Jt, 


OFFI*J6  PPnCEOUPE  GS. TRACK. CO^P  TOBE 

BEGIN 

...  *♦***//  IP  CKOT  ppT(0,.C,  /GS, track, comp/)  «, 

...  //  TOCA  3 TDCA.SiJPf)  %, 

MPTP  3 TOCA  4 TDCAT  5, 

TOCAT  e 0.985*T0CAT  $, 

END  S, 


DEFINE  boolean  procedure  GSFLAG  TO0F 

GSFLAG  s (DISCRETE. input, kORD  ,A,  lOOOC)  NEO  0 i, 


DFPifF  BOOLEAN  PROCEDURE  R.ALT.FLAGC)  TORE 

R. ALT. FLAG  3 DISCRETE. INPUT, WORD  ,A,  2000C  EQL  0 ) $, 


END  FINJ 

sentinel  CARO  FOR  (J-U08  TERMINAL 

«JFn  AEO,*  KiLFIL.KAl.FIL 
BEGIN 


ngPiK'g  procEOUPE  KFILI  (P.PP, TRANS, Q.H.R.SOUM.CDUM) 
WMeRE  REAL  ARRAY  P , FP , TR ANS , Q , COUM  $, 
real  H.R.SOL'M 
TORE  BEGIN 

real  array  DUM(16)  S, 

INTEGER  I.J  ?. 

Kf^ATRIX  (Ol'M, TRANS, P)  S, 

K-ITRI Y (PP, TRANS, OUM)  S, 

PP(fe)  2 PP(fe)  ♦ 0(2)  %,  ...  PP(2,2)  // 

PP(ll)  a PP(in  ♦ 0(3)  S,  ...  PP(3,3)  // 

oR(16)  2 PP(lh)  ♦ 0(u)  $,  ...  PP(U,a)  // 

FOR  I 3 I STEP  I UNTIL  « DO 

CD'JM(l)  2 PP(U4(I-n*l)YW*PP(«*(I-n*3)  S, 
SDUM  8 CP'.l*'(n  ♦ C0ljM(3)*M  4 R J, 

FOR  I 8 \ STEP  1 UNTIL  R DO 

FOR  J 8 1 STEP  I UNTIL  « 00 

P(«*n-l)4j)  s PP(R*(I-1  )*J)  - 

(COlJM(I  )*(PP(J)tPP(dYj)*H)  )/sdum  S. 

End  %, 


OrPlNF  PROrFOIlOE  KFILPfTPANS,YK,M,ZK,FK,SOllM,CDUM) 
*NEwF  Pf.AL  ARRAY  TRANS, YKiCDU'*  {, 

real  h,  ,FK  , SOl’M 
TOBE  BEGIN 

REAL  ARRAY  XKP((i)  «, 
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r.TFG?S  I *, 

9PAL  SCU*^?  ?i  ...  LOCAL  TO  KFIL2  // 

XKP(n  a XKH)  + TBANS  (3)*XK  (2)  $# 
xKP(2)  s xKf?)  4 o.  026uuua««auu*(XK(ouFKT  %, 
X«'>C3)  a TffAMSn  )*XK(3)  5»  ...  TRANS(5,3T  // 

XKP(ti)  e TPAVS(2)*XK(o)  s,  ...  TRANS(«fa)  // 

S0UM3  s H*  ( ?K-X‘<P  (3n  - XKP(l)  $, 

POP  1 a 1 STEP  I UNTIL  « 00 

xKcn  s xKPcn  ♦ CDuf-'(n*souM3/souM  $, 

end 


...  This  P&OCFPURE  GFNFSATES  TRANSPOSE CTR*M)  S» 

DEFINE  PROC^OiJPP  K'^iTRlX  (RES,  TP  , M5 
wwFBE  peal  Apbav  RESiTR,^^  TO0E 
begin 


RES(  n 

S 

1 ) 

4 

TR(5)*M(  5)  S. 

RES(  55 

s 

N( 

2) 

4 

TR(3)*M(  6)  S» 

RFS(  9) 

s 

•'i 

3) 

4 

TR(3)4N(  7)  $, 

RESn3) 

c 

4) 

4 

TR(3)*^*(  8)  «» 

RESf  2) 

a 

5) 

4 

0.028UaUUUU41U4*M(13) 

Si 

RES(  B) 

a 

N( 

fe) 

4 

0.02B444444U4O*Mna) 

Si 

»E^(10) 

a 

M( 

7) 

4 

0.02B4(Uuau44a*N(i5) 

Si 

RES(  UI 

a 

N( 

8) 

4 

0.026aaau4uutiu*M(i6) 

Si 

«FS(  35 

a 

T«( 

1) 

* 

N(  9)  S, 

RES(  T5 

a 

TR( 

1 ) 

* 

M(10)  S, 

»ER(lt  ) 

3 

TR( 

1 ) 

* 

N(ll)  S. 

RES( 15) 

a 

TR( 

1 ) 

4 

^(12)  S, 

RES(  41 

a 

TR( 

2) 

* 

N(13) 

RES(  6) 

a 

TR( 

2) 

* 

M(ia)  s, 

sESr 12) 

a 

TR( 

2) 

* 

M(15)  S, 

RESCIB) 

a 

TR( 

2) 

* 

M(lfe)  S, 

End  %, 


DEFINE  PROCEDUPE  *<  4 LCLR  ( Xi< , P ) 

-iHfRE  »cAl.  ARRAY  XK,P  TOBE 
BEGIN 

iNTfcREP  I,J 

FOR  I a 1 STEP  1 UNTIL  « DO 
BEGIN 

XK(I)  s 0.0  I, 

FOR  Jsi  STEP  I UNTIL  a DO 

P(4*(I-l**jn  a 0.0  S> 

ENO  S, 

ENO  S, 

END  FJNI 

sentinel  card  for  u-iloe  terminal 

• Jfn  4ED  ma XCNT , XCNT 
BEGIN 

...  SrujLATION  CONTROL  // 

...  NOTE  MAxCnT  'IiiST  be  LEG  100*KMAX  ()  // 


r>r»orir>oooooor>rinot*»oorior» 


OEPI‘E  PROCEr.U^E  "^AXCNT  TOBE 

f^AxCNT  s lOO^i'.^'AxO  S, 

I5EF1*>'E  l^’TEr.E‘^  P»OCEOuPE  K^IAX  TOBE 

K^AX  s 25t, 

DEFINE  boolean  p»OCEOUPE  C'^KPT  (SI>^CNT) 
i»HFOE  INTEGER  SHCM  TORE 

BEGIN 

CH<PT  s EALSE  f, 

INTEGFR  Ik  k, 

FOR  I*<  a 1 STEP  I UNTIL  ?5  DO 

IF  SI-CNT  E'GL  99*IK  THEN  CHKPT  a TRUE  S» 
F.no  s, 

END  FINI 


•JFn  4FO  ATANB.ATAMS 
BEGIN 

REAL  PROCEDURE  FORINT, ATAN2  $, 

DEFINE  peal  PRPCFOURE  ATanP(X,V) 

^’HE^E  REAL  X,Y  TOPE 
BEGIN 

REAL  ArOl  S,  AEOl  a IF  X EQL  0.0  AND  Y EQL  0,0  THEN  0,0 

ELSE  FQRInt(ATAN2,x,Y)  S, 

,,,  *****  it  ATAN8  s AEDl  /3,lUl592feS3  S, 

END  s, 

END  FTNI 

9N  FV'S  SIM4C,SI“AC 

SUBROUTINE  SIMAC(A,M0DE) 

C 

C **«  .scaled  VERSION  *** 


A a I/O  interface  VECTOR 

Xfl)  a PHID  a panK  RATE  IN  RADIANS/HOUR 

X(2)  a P-il  s BANK  IN  RADIANS 

XfB)  a LGAM  a LATERAL  FLIGHT  PATH  ANGLE  IN  RADIANS 

XfiJ)  a ATD  a Al.ONG  TRACK  DISTANCE  IN  nm 

X(S)  a CTD  c CROSS  TRACK  DISTANCE  IN  nm 

XTBI  a THAO  a PITCH  RATE  IN  RADIANS/SEC  . 

X(7)  a THA  = PITCH  IN  RADIANS 

x(A)  a ggam  s long.  Flight  path  angle  in-  radians 
XC9)  3 Z a altitude  In  nm 

X(IO)  a iO  a AIR  SPEED  In  KNOTS 

vein  a VG  a GROUND  VELOCITY  JN  KNOTS 

x(12)  a toe  a IL.S  LOC  BEAM  OEV,  IN  RADIANS 

xn3)  a GS  a ILS  G/S  Beam  dev.  In  RADIANS 

X(iu)  a CTR  a CROSS  TRACK  RATE  IN  KNOTS 

XMBI  a ATR  a Ai.ONG  TRACK  RATE  IN  KNOTS 

ICONTR  a i,  IC  XDO,  GEOMETRY,  a 0 DO  NOT  IC 

data  ICOnTR/1/ 

dimension  A(32),xn5),X0(9),x00(9) 
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JF  (TcrN'TS.l.T.  1 ) GO  TO  5 
PIE  s 5,l<il59aft53 
= 2.0 

G=^9625.3679 
G S A s 0 . 0 u ^ fr  i 3 ^ 3 
Ts0.05/(ii,0*3^j00,03 
A ( nso.o 

A(?T30,0 

C **  IC  GE016TPV 

00  I lal  ,0 

xoori  )so.n 

1 continue 

00  2 1=1,15 
X( 13=0.0 

2 CO^.■T^'Jil£ 

C **  ILS  GEn-^ETBY 

X (3)»-ii5.0/S7.296 

X(u3e;^,5 

X(53s-0.fe 

x(93  = 0.21^-17 

X(l03=l2S.n 

X ( 1 n = 125. 0 

i IF  (“OPP.VF.ai  GO  TO  u 

C **  TiCAN  GEC'^ETPY 
XX  = 1,0 

Xt33='i5. 0/57. 296 
X(‘13  = 70.0 
XC63S7.5 
X (9.)  =2.0 
X( 103=50 0.0 

XCI 1 3=500.0 

« IF  £.13  GO  TO  51 

c **  upaoI'MG  '^OL'O  “0''.£ 
x(33=  <i5. 0/57.296 

X (ii3  = l 50 , 0 
^ Xf53=SO.O 
X(93t2.0 
X(103=l?5.0 
X(l 1 3=125.0 
51  x3=X(33 

5 continue 

C COhPuTf  AI9C9AFT  BESPQNCE 
00  6 Jal.u 

X0H3  e (-1  ,u*x  (1  l^SeOO.  0*A  n 3*P1E  3 *3600,0 
xO(23  = xn  3 

XO(33  = G*ETNt  X(  2 3 3 /(  xni3*C0S(  X(2)  3 ) 
xO(a3=-i(  n 1 3 *Co?  (X  (33  3 
XOf53s-X(l 13*STN(X(333 

X0(63  s (-2.0*Xf63*3600.0*A(23*PIE3«3b00,0 
xO (7  3 sx (N  3 

xO(53  = *SeOO.O*xnn*x(63/SG‘?T(X(53**2*x(93**23 
xO(93sxnC3*S!'<(x(733 
C *♦  CALCULTF  INTFRGAL 

00  6 1=1,9 

x(I3  = XCl3*T*(Yr3n3*xCO(I33/2.0 
xoo(  n = xo(  r 3 

6 continue 

mo 


c «•  u?  04T4  «fST  V VECTOR 
xn2)sv(5WX(a) 
X(l3)aGSA-X(R)/(X{^i)-l,5) 


A(RisSI\'(X(7)) 

A nO)sCOS(X(7)  ) 

4nnasi»-(y(?n 

An2)8C05(x(2n 

c **  00  f'Or  need  to  C^<AnGE  AC13-16)  UNTIL  UP-OATE  OME  RANGE 
A Ci3)sSQRT  (y  (/i^ 

A(lU)sO.O 

4(15)80.0 

A(16)30.0 

4(17)  a 2.0*X(3)/PIE 
A(ld)  3 2.0*(X(3)-X3)/PIE 
4(19)  3 XX*16.0*X(12)/PIE 
A(?0)  3 16,0*X(12)/PIE 
A(21)  3 128.0*x (13)/P1E 
A(22)  3 X(lC)/P<iO.O  ' 

A(23)  a x(io)/eao,o 
4(2«)  3 X(9)/l,0 


C 

c 


4(25)  3 4(2) 
4(25)  3 X(7)/PIE 
A(2b)  3 4(1) 
4(20)  3 X(2)/PIE 


ICONTRsft 

End 


SENTINEL  CARO  FOR  U-llOS  TERMINAL 
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APPENDIX  F 


TEST  EQUIPMENT 


In  order  to  verify  and  maintain  the  562A-14,  two  test  equipment  units 
were  developed  at  Collins  during  the  DFDC  program.  These  two  units  are 
utilized  to  simulate  the  airborne  electronic  environment  of  the  562A-14 
and  as  a means  to  troubleshoot  the  system  hardware  and  software. 

The  971D-1  Digital  Flight  Director  Test  Set  (CPN  622-2022-001)  shown  in 
Figure  J-1  provides  all  the  inputs  which  the  562A-14  receives  when 
integrated  into  the  flight  control  system  and  serves  as  an  output  signal 
monitor.  This  test  set  acts  as  a stand  alone  test  unit  when  the  562A-14 
is  operating  on  internal  memory  and  is  utilized  with  the  971S-1  CAPS  Test 
Bench  for  hardware/software  tests.  The  acceptance  test  procedure  for  the 
562A-14  is  performed  utilizing  the  971D-1  alone.  Characteristics  of  the 
971 D-1  are  summarized  below. 

I.  Outputs: 

Roll  Attitude 
Pitch  Attitude 
Heading  Error 
Course  Error 
Glides  lope  Deviation 
Glideslope  Flag 
Localizer  Deviation 
Localizer  Flag 
Tacan  Deviation 
Tacan  Flag 
Radar  Alti tude 
Radar  Altitude  Flag 
DME  Distance 
Ai rspeed 
Mode  Discretes 

II.  Monitors  and  Displays: 

Bank  Steering  Pointer 
Bank  Steering  Pointer  Flag 
Pitch  Steering  Pointer 
Pitch  Steering  Pointer  Flag 
Glideslope  Deviation 
Glideslope  Flag 
Gli depath  Engage 
Lateral  Deviation 
Lateral  Deviation  Flag 
Flight  Director  Valid 
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The  971S-1  CAPS  Test  Bench  shov/n  in  Figure  J-?  is  a minicomputer  contrulled 
facility  v/hich  provides  a development  and  maintenance  environment  for  the 
CAPS  processors.  This  test  system  was  designed  and  utilized  during  the 
Digital  Flight  Director  program  and  will  be  available  for  maintenance  of 
the  562A-14.  The  bench  can  supply  the  562A-14  processor's  control  store, 
stack  memory,  and  instruction  store.  Via  the  controlling  minicomputer  and 
peripherals,  these  memories  can  be  loaded,  interrogated,  and  altered. 
Additionally,  a number  of  displays  and  controls  are  provided  to  aid  the 
testing  process.  The  test  bench  is  composed  of  the  six  major  components 
listed  below. 

1)  PDP-11/05  Processor 

On-line  control  of  the  test  bench  is  provided  by  the  PDP-11/05 
processor.  The  resident  executive  software  includes  the  programming 
necessary  to  control  all  peripherals  attached  to  the  PDP-11  Unibus. 

2)  ASR-33  Teletype 

The  user's  interface  to  the  executive  program  is  via  directives 
entered  on  the  teletype  keyboard.  In  addition,  the  teletype 
provides  paper- tape  I/O  capability. 

3)  HP-7970B  Magnetic  Tape  Unit 

The  HP-7970B  provides  9-channel  magnetic  tape  I/O. 

4)  PICO  1011  Tape  Controller 

The  tape  controller  provides  the  necessary  formatting,  parity, 
and  control  electronics  to  interface  the  POP- 11/05  processor  to 
the  magnetic  tape  unit. 

5)  Hicromemory  3000  Core  Memory 

The  Micromemory  3000  provides  8K  (expandable  to  32K)  words  of 
16-bit  core  memory.  It  can  be  used  as  the  stack  memory  and/or 
the  instruction  store  for  the  CAPS  processor  under  test. 

Additional  memory  units  can  be  attached  to  the  CAPS  Transfer  Bus 
for  expanded  storage  capability. 

6)  CAPS  Test  Adapter 

The  CAPS  Test  Adapter  is  a Collins-built  peripheral  which  is 
attached  to  the  POP- 11  Unibus.  Its  primary  functions  are  to 
interface  the  CAPS  Transfer  Bus  and  CAPS  Control-Store  Bus  to 
the  PDP-11  Unibus. 
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